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PREFACE 


The  thoory  and  application*  of  Kalian  filtering  have  no*  been  under  development  for  over 
ten  year*.  Thin  general  aroa  h*3  achieved  a  level  of  maturity  and  importance  to  easily 
Justify  a  thorough  treatment  of  the  subject.  Ill  vie*  of  the  particular  importance  of  Kalman 
flltorlns  techniques  to  the  field  of  guidance  and  control  tho  Guidance  and  Control  Panel  of 
NATO- AGAUD  recommended  that  such  u  text  be  developed  under  tho  auspices  of  NATO-AGARD. 

This  textbook  is  ths  result  of  that  reoommondstion,  The  text  is  organized  into  threo 
principal  parta.  The  first  part  examines  ths  theory  of  Kalman  filtaring  in  depth.  A  number 
of  significant  new  results  of  fundamental  importance  arc  included  hart.  For  instance,  such 
questions  si  exlstenco  of  Kalman  filters  under  very  general  condition*,  Kalman  filtering  for 
Qauas-Markor  procesiea,  nubnptimal  Kalman  filtering  techniques,  and  other  arses  are  trsatsd 
her*. 

The  second  part  of  tho  text  deals  with  tho  general  area  of  related  topics.  ftiestione  of 
the  comparison  of  Kalman  filtering  wltta  other  approaches  such  as  Bayaelnn  and  maximum 
likelihood  estimation,  nonllnoar  filtering,  linear  and  nonlimar  smoothing  (post-flight  data 
analysis),  and  other  topic*  ara  reviewed  in  depth  in  this  part. 

The  third  part  1*  a  very  coaprehenslve  review  of  nany  of  the  important  applications  of 
Kalman  filtering.  Although  many  very  speolfio  areas  of  application  are  trsatsd  in  this  part, 
■any  fsnsrsl  principles  and  •bsohniquoe  for  a  .very  -broad  range  of  .applications  of  Kalman 
filtering  will  be  found  hers.  As  a  result,  ths  reader  should  also  find  this  part  quits 
valuable  no  matter  what  particular  application  ha  might  have  in  mind. 

It  la  a  great  pleasure  to  acknowledge  the  contributions  of  many  individuals  who  mads  this 
text  possible,  rirst  of  eu,  Professor  W.trliley'  a  contributions  sa  ths  first  Pinal  Chairaan 
pf  ths  fluidance  and  Control  Panel  osnnot  be  prslssd  too  highly.  Hie  outstanding  efforts  in 
guiding' this  Panel  during  Its  formative  stages  osnnot  be  prslssd  enough.  This  book  is  one 
of  the  fruits  of  his  efforts.  All  ths  members  of  ths  Duidsnc*  and  Control  Panel  were  solicited 
tor  their  advice  and  auggaatlona,  and  their  help  is  also  graatly  appreciated.  Colonel 
L.Susarman  and  Mr. Frank  Sollivan  provided  much  important  support.  Mr  O.H.Bohuok  made  many 
important  suggestions.  Colonel  W.  Studabaker  and  Major  C. Mount  provldad  invaluable  aaaistanoa 
in  thair  rolea  as  auidanoe  and  Control  Panel  Executive  Officers.  Mrs  aladys  Flynn  provided 
many  Invaluable  services. 


Cornelius  T. Leondes 


CONTENTS , 


PREFACE 

CHAPTER 

CHAPTER 

Section 

Section 

CHAPTER 

CHAPTER 

CHAPTER 

CHAPTER 

CHAPTER 

CHAPTER 

CHAPTER 

CHAPTER 

CHAPTER 

CHAPTER 

CHAPTER 

CHAPTER 


P*RC 

ill 


PART  1  -  THEORY 

v 

1  LINEAR  ESTIMATION  THEORY 

by  ll.  *.  SorroHon  and  A.  K  .  StuliUcrud  I 

i  FURTHER  COMMENTS  ON  THE  DERIVATION  OF  KALMAN  FILTERS 

I  DERIVATION  OF  THE  KALMAN  FILTERING  EQUATIONS  FROM  ELEMENTARY 


STATISTICAL  PRINCIPLES  „ 

by  P.M,  Barium  and  D.  E.  Humplir  leu  43 

II  GAUSSIAN  ESTIMATES  AND  KALMAN  FILTERING 

by  Y. Ocnin  B1 

3  —'.COMPUTATIONAL  TECHNIQUES  IN  KALMAN  FILTEKSNO 

by  Stanley  F. Schmidt  OH 

4  MODELING  ERRORS  IN  KALMAN  FI  LTERS 

by  T.Nlehlmura 

3  Sl'BOFT I MAL  KALMAN  FILTER  TECHNIQUES' 

by  A.  R.  Stubborud  and  0.  A.  R timer  103 


PART  II  -  RELATED  TOPICS 

6  COMPARISON  OF  KALMAN.  BAYESIAN  AND  MAXIMUM  LIKELIHOOD  ESTIMATION 

TECHNIQUES' 

by  H. f. Sorenaon 

7  >  NONLINEAR  FILTERINO  AND  COMPARISON  WITH  KALMAN  FILTERING- 

by  Lawrence  Schwart*  143 

S  LINEAR  SMOOTHING  TECHNIQUES  (POST-FLIGHT  DATA  ANALYSIS).' 

by  Herbert  E. Rauch  183 

9  NONLINEAR  SMOOTHING  TECHNIQUES  ’ 

by  John  R.Peller  '  ‘»3 


PART  III  -  APPLICATIONS 

10  ’  GENERAL  QUESTIONS  ON  KALMAN  FILTERINO  IN  NAVIGATION  SYSTEMS 

'  by  Larry  D. Brook  and  Oeorse  T. Scheldt 

11.  }  ^APPLICATION  OF  KALMAN  FILTERINO  THEORY  TO  AUOMENTED  INERTIAL 
*  NAVIGATION  SYSTEMS 
by  J.R.  Huddle 

12  "APPLICATION  OF  KALMAN  FILTERINO  TO  OARO/INERTI AL  HEIGHT  SYSTEMS  ' 

~  by  P.M.  Barham  »nd  P.Manville 

13  '  ^APPLICATION  OF  KALMAN  FILTEKINO  TO  THE  C-5  OUIDANCE  ANO  CONTROL 

SYSTEM 

by  Stanley  F.  Scheldt,  John  0.  Members  and  John  S.Lukeeb 

14  APPLICATION  OF  KALMAN  FILTERINO  TECHNIQUES  TO  THE  APOLLO  PROGRAM^' 
by  Richard  H.Battln  and  Gerald  M. Levine 

SOME  APPLICATIONS  OF  KALMAN  FILTERING  IN  SPACE  OUIOAN  E  - 
by  J . F. Bel lanton 1  j 


203 

231 

269 

2S3 

333 


CHAPTER  13 


363 


ClAPTd  l« 

I  ^application  or  mux  rummo  rot  me  alioaient  or  cariiei 
AiocoirT  mvinu  navi  cation  ototui 
hr  J.T.koakt 

•ootiM  ti  •  Mtituttx  at  »u  limit  tots  muiiutt  roii  or  kalian  filtooino  ' 

hr  M.HrtrNk  ut  ■.laUuiOirio  - 

CIAPTII  17  -  URINE  Am  I CATI  OKI  0  7  I A  LI  4k  ULTEIMO 
hr  Miltmrtk  aad  J.itola 


coaptei  to  *  orttiAi  lie  or  iedunbant  inpomation  in  an  inertial  naviiaikx  ' 
-  ovatea 

hr  P.O.uagor  md  a,  oil 

CVAPTil  to  AmiCATI ON  or  KALIAN  FILTERING  TETON  I  oof*  TO  ITIArOOIN 
IflTCI  initial  alioniknt 

h|  Earl*  0  fracErr  aid  LtaaarO  lahlaa 


ClAfTEI  «0 


•x  A 


KALIAN  FILTEI  ALOgfNTFD  IAIINE  NAVIGATION  IVKTII 
hr  I  lalaat.darl.  a *0  D . Oidra  V 

/ 


Pago 

000 

IM 

401 

<01 

401 

111 


f 


NOTATION 


t 

*0 

I(t> 

I<t> 
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l(t) 
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the  Independent  variable,  usually  referred  to  as  ttmo 
Initial  time 

the  residual  or  innovation*  procenn  and  defined  to  be  i(t /r)  b  j(t)  -  H(t)i(t/v) 

additive  whlte-noloo  prnoeas  In  the  measurement  data  with  mean  zero  and  covariance  matrix 
R(t)8(t  -r) 

additive  white-  '.otae  proceaa  In  the  plant  with  mean  zero  and  covariance  matrix  Q(t)S(t-T) 

tho  n-dlmenalonnl  ateto  vector  doaerlbed  by  a  linear  differential  equation  i  r  P(t)x  +  w 

estimate  of  tho  state  |(t)  xlvon  the  mnaeurement  data  Z CO 

error  In  tho  estimate,  J(t/T)  &  j(t)-£(t /r) 

the  noise-free  measurement  dsts,  j|(t)  »  H(t)g(t) 

the  measurement  deta,  |(t)  $  H(t)j  +  i 

the  meesureieent  data,  Z(t)  for  all  t0  <  r  <  t 

eroaa-oorrelatlon  matrix  for  plant  and  meamursment  nolle,  E[*(t)vT(r)]  *  C(t)5(t-r) 

pleat  matrix,  j  >Kt)jtw 

observation  matrix,  j  =  H(t)2+v 

optimal  lain  matrix  for  unbiased  minimum  variance  filter 

observability  matrix.  M(t,r)  g  /J* »T (<r, t )HT (er)R- 1  (v)H t )  do- 

oovarlanoa  of  the  error  in  the  eatlmate,  P(t/r)  6  E[|(t/T)JT(b/r)] 
eovarlanoe  matrix  for  tha  plant  nolle  w(l) 
oorarlanoe  matrix  for  tha  maaauramant  aolat  v(t) 

transition  matrix  aamoelatad  with  tha  plant  equation,  4(t,r)  a  F(t)#(t,T)  ,  #(r,r)  «  I 

transition  matrix  aaaoolatad  with  the  filter  dynamloa,  ’J'tt.v)  =  [F(t) -K(t)H(t)]'l,(t,v)  , 
?(T,T)  =  I 

Identity  matrix  of  appropriate  dimension 

the  quantity  (  )  U  a  vector  (or  column  matrix) 

the  matrix  trinepose  of  (  ) 

the  matrix  lnveree  .of  (  ) 

the  aatrlx  lnvaree  of  (  )T 

•xpeoted  value  of  the  random  variable  a 

tha  Dlrae  delta  function 

tha  quantity  (  )  la  dafined  to  be  equivalent  to  [  ] 
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CHAPTER  1  -  LINEAR  ESTIMATION  THEORY 


H.  w.  Sorenson  end  A.R,  Stubberud 


1.  THE  LINEAR  ESTIMATION  PROBLEM 
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1.1  Introduction  to  tho  Linear  Estimation  Problem 

A  large  clams  of  eat lent Inn  prohlemn  la  concerurd  with  find Inn  an  optimal  estimate  of  some  quantity  (an  unknown 
parameter,  a  random  variable,  or  a  random  algnnl)  when  a  linear  function  of  thla  quantity  corrupted  by  nn  additive 
noise  Is  available  for  gonoruting  the  estimate.  One  of  the  first  Btudios  of  this  class  of  problems  was  performed 
by  dalles1  in  the  early  1800' s.  In  this  work  he  studied  least-squares  estimates  of  unknown  parameters. 

In  the  tsrly  lBlO's  wiener’  and  Kolmogorov’  attacked  the  class  of  problems  dealing  with  estimation  of  random 
algnala.  Tha  key  raault  from  thla  work  la  sn  integral  aquation  called  the  Wiener-Hopf  equation.  Tho  solution 
of  this  aquation  la  a  weighting  function  which,  whun  convolved  with  the  corrupted  linoar  measurement,  products 
an  unblasod  minimum  variance  estimate  of  the  random  signal.  Since  tho  Wiener-Hopf  equation  can  only  bo  oolved 
explicitly  for  certain  special  oases  of  the  general  problem,  this  work  hns  only  limited  practical  application. 

Many  generalization*  of  this  work  wars  prssanted  In  the  ISAO's  and  lBSO's  but  none  of  theao  Improved  Its  practical 
applicability1*"’. 

In  the  1B30’*  the  Idea  of  generating  leaat-squKres  estimates  recursively  was  Introduced.  Thla  Interest  wrs 
stimulated  by  the  increased  usage  of  digital  oonputars,  These  estimates  are  generated  dynamically  and  the  data 
processing  algorithm  la  either  a  differential  or  a  difference  aquation,  Carlton*  asserts  that  tha  first  work  on 
thla  gubjeat  was  dons  by  pollin'  shout  loss.  In  1888  Swerllng  published  s  Rand  Corporation  report  (whloh  received 
wider  distribution  In  1B8B  In  tho  Journal  uf  the  Astronautloal  Sciences10)  that  presented  a  raouraive  filtering 
procedure  alnllar  to  that  described  shortly  thereafter  by  Kalman11.  Tha  latter  work  Is  generally  considered  to 
have  aparked  the  widespread  lntaaeat  In  the  subject  .and  aubaequent  rtferenoee  to  "Kalman  filtering". 

The  paper  by  Kalman11  In  1S00  Introduced  a  different  approach  to  the  problem  of  Wiener  and  Kolmogorov  for 
random  eequenoes.  In  ISfll,  Kalman  and  Buoy"  generalized  the  reeulto  to  random  processes.  Basically,  this 
approach  circumvents  the  problem  of  solving  the  Wlener-llopf  integral  equation.  By  recognizing  that  digital 
computers  era  much  more  effeatlve  at  solving  differential  aquations  than  Integral  equations,  Kalman  and  Bucy 
transformed  tha  Integral  equation  Into  an  equivalent  differential  equation.  Then,  rather  than  demand  an  analyti¬ 
cal  solution  for  this  equation,  they  recognized  that,  from  a  practical  standpoint,  It  la  better  to  put  the  com¬ 
putational  burden  on  the  computer.  Theee  raeulta  are  oloaely  related  to  thnee  obtained  for  sequontial  laaat-squeraa. 
tat  last  Ion.  The  practicality  of  tho  Kalman  approach  to  the  estimation  problem  has  mode  It  lmmenssly  popular  In 
aeroepaoa  applications,  such  as  In  navigation  and  guidance. 

It  Is  the  intent  In  this  chapter  to  discuss  the  fundamental  aspects  of  tha  unbiased,  minimum  variance,  linear 
estimation  probltm.  The  treatment  of  the  problem  aa  presented  here  has  Identifiable  roots  In  the  paper  by  Kalman 
and  Buoy1’  and  even  more  ao  In  tha  remarkable  treaties  by  Kalman  that  constitutes  Reference  13.  However,  the 
presentation  describes  not  only  those  early  and  basic  results  but  attempts  to  present  the  developments  In  the 
year*  since  the  aemlnsl  papers  appeared  that  alther  provide  Insights  into  the  foundations  or  which  add  slgnifl- 
oently  to  the  theoretical  structure.  It  may  be  an  overstatement  to  suggest  that  then  are  as  many  derivations 
of  the  Kalman  filter  equations  as  there  an  workers  In  the  field.  On  ths  other  hand  It  cannot  be  denied  that 
there  ere  many  approaohea  to  tha  probing  and  each  has  Its  vociferous  supporters.  It  it  not  practical,  nor  la  It 
desirable,  to  attempt  to  latlsfy  all  taataa.  The  development  here  Is  dsslgned  to  appeal  to  Intuition  and  to 
provide  Insight  that  axplalna  those  aspects  which  may  not  be  obvious.  In  taking  this  approach,  mathematical 
rigor  It  sacrificed  or  details  era  omitted  then  it  appears  that  greeter  oltrlty  can  be  sohitved  by  ignoring  what 
amounts  to  be  a  technical  detail  that  does  not  affaot  tha  fianl  results. 

The  bsslo  mathematical  modal  and  s  more  praoise  definition  of  the  linear  estimation  problem  ar*  given  In 
Section  1.2,  Boas  variations  and  generalization!  of  thla  eodel  and  problep  are  considered  in  Sections  2  and  3. 

A  detailed  suaaaary  of  the  more  Important  results  of  Sections  2  and  3  1*  given  In  Section  A.  It  li  suggested 
that  this  section  be  read  aftar  completing  section  1.2  and  belora  going  to  tha  detailed  discussions  of  sections 
2  and  3.  In  thla  way  this  summary  can  be  used  as  a  guide  through  the  eeemlng  morses  of  Kslaan-Buoy  filter  theory. 
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t.B  The  Rethematleal  Model  and  Probltm  Statement 


Consider  a  dynamical  ayate 
equation. 


•tate  evolution  le  described  by  a  linear,  etoohastlo,  vector  dlfferentlel  ®  wl * 
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i  In  «n  n-dlna-nslonnl  stato  vector 

E(t)  la  an  n«n  matrix  whoao  clonionts  arc  continuous  functions  of  the  Independent  variable  t 

»  la  an  n-dlmonaloiml,  gaussian  whlto-nolse  process  with  the  following  statlatloa 

E(E(t)]  =  0  far  all  t 

E[w<t)*fT(r)]  =  Q(t)S(t-T)  , 

where  Q(t)  it  an  n*n  symmetric,  non-n<'cat  ivo-rlof  inito  matrix  mul  $(t -r)  in  thu  Dirac  delta  function- 

The  initial  state  i(tQ)  in  a  random  variable  »ith  known  stfitlfltira. 

eLx (t0)l  = 

E([s(t.)  -  a  ]  [j(t0)  -  a0)T)  H 


Alao,  t't.)  la  lndapeodant  of  w(t)  ,  that  Is, 


K[s(t)aT(t,)]  =  o  for  all  t  . 


The  solution  of  Equation  (1.1)  la  (Ivan  by1 


I(t)  =  +  {**< t,T)|(r)  dr  , 


ahare  4(t ,r)  la  the  transition  matrix  and  la  the  solution  of  thq  matrix  differential  equation 


d4(t,r) 


=  r(t)4(t,T)  i  $(t,t)  s  1  for  all  t 


The  tranaltion  aatrlx  baa  the  property  that 


Thla  Imp Ilea  that 


'  ®(tk,tJ)*<tJ.t1)  a  *(tk,tt)  for  all  t^.tj.tj 


4"‘<tk,tj)  *  4<tj,tk>  , 


•o  that  4  la  nonalniular  for  all  tha  t^.tj  .  The  aolution  and  its  properties  *111  be  used  In  tha  euoc-iedlng 
dieouselon. 

The  only  lntoraiatlon  available  about  the  state  are  m  measurements  j(t)  that  are  related  to  j(t)  accord¬ 
ing  to 


S<t)  =  H(t)j(t)  +  v(t)  .  (1.2)  1 

The  v(t)  la  an  m-dlMnalonal,  (auaaian  white-noise  process  with  the  statistics 

*(t(t)]  *  0  for  all  t 

*tl(t)lT(T)]  a  *(t)5(t-T)  . 

Tha  plant  nolaa  *(t)  and  tha  eaasuramant  nolsa  v(t)  era  assumed  to  ba  Independent  for  moat  of  the  dis¬ 
cussion,  althoush  tha  leneraUxatton  to  corralatad  prnouaaa  is  diaouasad  in  Section  2.1.3.  The  symmetric  m  «  re. 
matrix  R(t)  must  ba  unsumad  to  be  poattlve-deflnlte  for  the  straightforward  development  of  the  Kslmn  filter 
equations.  Whan  R(t)  Is  not  positive-definite,  It  la  neoesaary  to  introduce  the  special  considerations  relating 
to  the  colored-noise  problem  diecuseed  In  Section  2.2.  Also,  by  s  corruption  of  the  language,  the  matrices  Q(t) 
and  R(t)  till  often  be  referred  to  aa  the  noise  covariance  matrices,  althoush  the  covariance  matrices  actually 
are  of  Infinite  magnitude  because  of  the  delta  function. 

The  estiaatlon  problem  associated  with  the  system  Equations  (l.l)  -  (1.2)  ctn  now  be  defined. 


l/nhiast d,  .1/lNinnm  Variance,  I. inear  Estimation  Problem 


Olveti  thn  linear  system  doscrlbod  by  Equations  (1.1)  and  (1.2).  dutrrmlnn  an  est lantr  S(tn)  of  tho  etnto 
x(t)  that  la  a  llncnr  function  nf  nil  measurement  data*  z(«r)  ,  te  <  o  <  t  ,  and  satisfies  thn  following 
conditions: 

(1)  J(t|r)  la  unbiased  ao  that 

Eli(t|r))  r  Efi(t)]  . 

(11)  j£(tlr)  la  "heat"  In  tho  sense  that  tho  expoctod  value  of  tho  square  of  tho  error  magnitude  In  mini  ml  nod. 
Thun,  the  eetlmete  J(th)  ie  chosen  no  that 

E((j(t)  -  *(t It) ]t  [j(t)  -  jl<tlT)]}  =  mlnlimim  . 

The  estimate  that  la  ohtalnod  depends  upon  the  amount  of  data  that  In  available  (i.o.  an  defined  by  r)  and  can 
be  described  In  tormn  of  three  spec  in l  problems. 


Prediction:  Suppose  that  tin1  state  at  e  time  t  In  to  bo  estimated  from  data  7,Cr)  »hnre  a  <  t  .  Thus, 
the  etato  j(t)  la  to  be  predicted  from  data  obtained  at  tlmea  prior  to  tho  tlmn  t  .  This  ahull  be  referred 
to  here  aa  the  prediction  problem. 

Filtering:  Consider  the  problem  ot  estimating  the  &(t)  from  data  (!.«.  t  »  t).  This  shall  be 

referred  to  as  the  filtering  problem. 


Smoothing:  Suppose  that  the  state  j(t)  la  to  bo  estimated  from  data  J(t)  whnrc  r  >  t  .  In  this  case 
j(t)  la  estimated  from  data  obtained  at  times  prior  to,  coincident  with,  and  subsequent  to,  the  time  of 
interest,  t  .  This  shall  be  referred  to  as  the  smoothing  problem. 


Those  three  special  casea  cf  tho  estimation  problem  are  also  referred  to  as  the  extrapolation, amoothfh'g  and 


Interpolation  problem*  (see,  for  example,  References  2  and  IB).  Tho  problems  have  been  stated  In  thn  order  of 
increasing  complexity  of  solution.  Tho  emphasis  here  is  upon  t‘ho  prediction  and  filtering  problems,  although 


the  smoothing  problem  la  dlsousand  briefly  in  Section  2.3.  The  so-called  Kalman-Buoy  filter  is  involved'wlth 


the  first  two  canen. 


1.  SOLUTION  (IF  THE  LINEAR  ‘ESTIMATION  PROBLEM 

I.  1  Llnaar  Prediction  and  Filtering 

J. l.i  Heuristic  Derivation 

A  derivation  of  the  Kalman-Buoy  equations  le  presented  in  this  section  thst  sppesle  primarily  to  intuitive 

reasoning  rather  than  mathematical  rigor.  This  approach  is  taken  initially  to  provide  insight  into  the  character 

of  the  eolutlun  which  is  ehuwn  mare  rigorously  in  the  following  section  to  prov‘de  the  unbiased,  minimum  varinnoe 
estimate  of  the  state  g(t)  based  on  the  measurement  data  2<t>  • 

Suppose  that  an  estimate  of  the  state  j(t5)  le  available  at  some  time  t0  that  is  based  upon  measurement 

data  2(tg)  .  Let  this  estimate  be  denoted  as  |(t„lt0)  .  In  Equation  (1.1),  it  is  seen  that  the  stria  changes 
in  aooordanoe  with  a  linear  differential  equation  with  a  white-noise  forcing  function.  The  process  o(t)  has 
zero  moan  and  the  value  at  different  times  is  uncorrelated,  regardless  of  th'  magnitude  ot  the  time  difference. 
Thus,  it  is  reasonable  to  expeot.  in  the  absence  of  additional  data,  that  the  behavior  of  tho  estimate  would  be 
dsscrlbad  by 

£  =  T(t)5  ,  t  >  t0  .  (2.1) 

where  g(t0 I t 0 )  Is  known.  But  when  measurement  data  are  available  for  time  eubsequent  to  t0  one  can  consider 
the  residual  (l  e.  the  difference  between  the  measurement  data  g(t)  and  that  predicted  by  the  estimate 
H(t)J(tlt)>. 

£(t)  =  S(t)  -  H(t)$(tlt)  .  (2.2)’ 

This  residual  la  referred  to  by  Kallath"  aa  the  Innovation!  process  and  will  be  examined  in  more  detail  In 
Baotlon  2.  1.2. 

The  realduai  oan  he  considered  to  provide  an  indication  of  the  error  in  the  estimate  &(tlt)  .  Lst  us  assume 
that  this  srror  will  be  used  to  modify  the  estimate  provided  by  Lqimtlon  (2.1)  by  Introducing  an  umlmoun  weighting 
or  gain  matrix  K(t)  .  Using  this  weighting  mntrix,  assume  that  tho  eutlmate,  including  all  new  measurement  data, 
is  to  have  the  fora 

i(tlt)  =  r(t)g(tlt)  ♦  K(t)ls(t)-H(t)g(tlt>]  for  t  >  t„  ,  (2.3) 

•  Henceforth,  th#  collection  of  ■•inurement  dntn  %<*)  on  an  lntervnl  t0  <  cr  <  r  will  be  denoted  i w  2(f)  . 
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where  xit.jitj)  ift  known.  To  simplify  not., don,  the- arturo  nts  of  tlm  estimate  *111  be  Mipprosnod,  so  llmt  i 
*111  be  synonymous  with  S ( 1 1 1 ) 

Utlnc  the  for#  assuimd  in  Equation  (2.3).  the  nintrlx  K(t)  will  bo  chosen  no  that  the  vnnnnce  of  the  error 
li  minimized  .is  required  In  the  ststement  of  the  flltorlns  problem  in  Section  2.  1.  Note  nlso  thnt  the  solution 
of  Equation  (2.1)  yields  thn  solution  uf  the  prediction  problem  for  t  >  t0  . 

First  note  thnt  the  cstiemtc  provided  by  Equation  (2.3)  Is  unbiased  if  the  Initial  condition*  «re  selected 
In  sn  appropriate  manner 

Equation  (?..?)  ie  on  imbinm/  estimator  if  thr  inilio!  condition  ^{t0 1 10)  s.itis/irs  th*  constraint  th.it 

E[i(t0lt0)3  =  Et.T(t0>]  .  (2.4) 


To  verify  this,  not#  from  Equation  (1.1)  that 

E[i)  #  F(t)F.[j!  , 

ftnd  from  Equation  (2.3)  that 

tCxI  =  F(t)E(i]  +  K(t ) (ttzi  -  H(t  )E[x!  }  . 
But  from  Equation  (1.2)  one  sees  that 


so  that 


(hue,  It  follova  that 


Etsl  =■  H(t)E[il  , 


E[|]  =  r(t)E[X)  ♦  K(t)H(t){E[x] -E[|l> 


—  (E[S-xl)  =  <F(t) -K(t)H<t)}E[i-5] 

at 


Thla  la  a  hoaocenwoua ,  linear  differential  equation  In  tha  variable  l[j - £]  so  Its  solution  has  tho  general 
fora 

Eti(t)-i(t)]  =  H(t,t0)*tj(t0)-I(t#it,))  . 

Tha  aatrla  t  la  tha  transition  matrix  aasoclatad  with  the  filter  dynaaloa  and  is  ths  solution  of  the  matrix 
dlfferentlsl  equation 


ftt.t,)  a  [r(t)  -K(t)H(t)lf<t,t0)  .  V(t„,t,)  #  I  . 


Thua,  If 

■Ijlt,)]  =  E[*(t,lt0)]  ,  / 

It  follow*  that 

E[*(t)]  =  E[g(tlt>]  , 

to  that  tha  aatlaata  la  unbiased. 

Ualn«  the  fora  for  tha  eatiaat*  aaauaed  In  Equation  (2.3),  conalder  tha  rtformulated  filtering  problem. 
atna  tha  tlaa-varylnt  matrix  K(t)  to  that  E[(i-|>t(e-|)]  la  minimised. 

Deter 

Let 

I(t|t)  |  t(t)  -  |(tlt>  . 

(2.5) 

•o  that 

-  iCfxl 

*  trace  E[XJt]  . 

Define 

P(t It)  A  ElI(tlt)IT(tit)]  . 

(2.8) 

Thus,  It  is  dsslred  that  ths  sain  aatrlx  K(t)  be  ehoacn  to  alnlnist  the  trace  of  the  error  covariance  matrix 
P(tlt)  . 

Tha  rata  of  chant*  of  the  trror  In  the  eatiaat*  ie  obtained  by  uslnc  Equations  (11),  (1.2),  and  (2.3). 
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d  . 

—  x 
fit  ' 


-  F(t)l  ♦  w  -  P(t)S  -  K(t)[g-H(t)g] 
=  [Kftl  -K(t)ll(t)]ji  -  K(t)J£  +  *  . 

The  ret*  of  chance  of  the  error  rover iane.e  matrix  Is  given  by 

(P)  =  eC£&t]  +  Etif] 

□  t 


(2.7) 


(2.8) 


whore 


ElxXT]  =  E([P(t) -K(t)M(t)lxlT  -  K(t)iST  4  wgT} 


But  It  follows  from  the  assumptions  about  thu  noise  processes  that. 

E[jf(t)?T(tlt)]  =  - i  R(t)KT(t) 

»nd  E[w(t)gT(tlt)]  =  i Qft)  . 

For  example,  consider  the  first  of  these  two  relations,  Tho  solution  of  Equation  (2.7)  has  the  form 

g(tlt)  =  »(t,t<))X(t,lta)  -Jt'f(t,T)K<T)2(T)  dr  +  P  Ut.r)s(T)  dr  . 

t0  "*0 

Using  this,  one  sets  that 

•  E[v(t)XJ(tlt)J  =  E[x(t)i(t0lt0)]1/f(t,t0)  -  f*  E[x(t)KT(r)]KT(T)tff(t,7)  dr  +  f  *  e[l(t)iT(r)]¥r(t,r)  dr 

**0  *o 

But  *lY(t7I(t,lt,)]  =  0 

and  E[l(t)wT(r)]  =  0  , 

from  the  baa  in  assumptions,  ao  that 

E[l(t)|T(tlt)]  =  -/tR(r>8(t-r)KT(T)llT(t1T)  dr 
**0 

=  -  {  Rft)KT(t)  . 

As  a  rsault,  tho  error  covarlanoe  matrix  is  found  to  satisfy  ths  dlffarsntial  equation. 


-  P  =  ■  [r<t>  -K(t)H(t)]P  +  P[F(t)  -X(t>H(t)]T  +  K(t)R(t)KT(t)  +  q(t) 

at 


(2.0) 


It  la  Important  to  realize  that  Equation  (2.0)  describes  ths  behavior  of  the  srror  covariance  matrix  for  any 
(tin  matrix  K(t)  .  This  rslatlon  is  next  ustd  to  derlvs  the  K(t)  that  yields  the  tlnimuis  error  variance. 
Also,  note  from  the  definition  that  P(tlt)  is  symmetric. 

Combine  all  terms  that  contain  the  unknown  gain  matrix  K(t)  .  Then 

P  a  F(t)P  +  PFT(t)  +  Q(t)  >  {K(t)R(t)KT(t)  -  K(t)H(t)P  -  PHT(t)  KT(t)>  . 

The  terms  outside  ths  brackets  cannot  be  sffected  directly  by  the  choice  of  the  gain  sstrlx  K(t)  ,  so  they  will 
be  Ignored  for  the  moment.  The  matrix  R(t)  has  been  assumed  to  be  eymmetrlc  end  positive-definite  to  It  cen 
be  fsotored  into  the  produot  of  s  noneingulsr  matrix  S(t)  and  ite  transpose  ST(t)  , 

B(t)  •  =  S(t)BT(t)  . 

Assume  the  existence  of  s  matrix  Aft)  such  that 

krkt  -  khp  -  phtkt  =  [ks  -  a]  [ks  -  a]  t  t  AAt  . 


r  .a.,  •  -  >  ..  r..  .*»  .  •  .V  -  w. 
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For 'this  to  bo  valid,  ohoose 


a  m  PH'S"* 


V  . 

U  -.  •  . .  .  • 


HfeJttATS 


i 


where  [  ]'r  denotes  tho  Invars*  of  [  ]T  .  Kith  this  choice  for  A  ,  the  dlffernm  ml  equation  for  P  becomes 

P  -  FP  +  PFT  '+  Q  -  PmV'HP  +  fi: - PHtR"  1  ] lltK - PltTR* 1 J T  .  (2.10) 

Thus  the  fain  matrix  ontors  the  quadratic  term  alone.  For  a  proscribed  Initial  value  P(t0 )  and  roe-ignition 
of  the  fact  that 


d  d 

—  (trace  Pi  =  trace  —  (P)  , 
dt  dt 

It  follova  that  (trace  P)  Is  minimized  at  each  time  by  choosing  K(t)  so  that  P  la  as  small  as  ponalhle.  This 
la  accompUahad  by  ohoualnc  K  ao  that  the  quadratic  term  in  F.ountlon  (2.10)  in  eliminated.  Thun,  tho  optimal 
gain  la 


K( t )  =  P(t I t)HT(t) R' 1 (t)  (211) 

and  ths  srror  oovarlancs  nutria  for  the  optimal  gain  la  described  by 

P  =  P(t)P  +  PF*(t)  -  PHT(t)*‘l(t)H(t)P  +  Q(t)  ,  (2.12) 

alth  prescribed  Initial  condition  P(tg)  .  The  arguments  leading  to  Equation!  (2.11)  and  (2.12)  oan  be  made 
•ore  preo'lae  by  using  variational  argument a.  as  disoussed  by  Athens1’.  The  srror  covsrlanos  matrix  P(tlt)  Is 
determined  by  solving  Equation  (2.12).  This  aquation  Is  a  matrix  Rloatti  equation1'  and  la  dlscuasod  In  mors 
detail  In  Section  3.2. 

This  completes  the  heuristic  derivation  of  the  equations  of  the  Kalmar-Bucy  filter. 

Smeary  of  Principal  fleiulli  . 

The  unbleeed,  minimum  variance  estimate  of  the  linear  system  described  by  Equations  (1.1)  -  (1.2)  Is  given 
me  "the  solution  of  the  system 

i(tlt)  a  F(t)i(tlt)  +  K(t)[*(t)-H(t)i(tlt)]  .  (2.3) 

share  i(t0lt„)  Is  selsated  so  that 


iCKt.lt,)]  =  B[i(t0)]  . 


Ths  optimal  gain  matrix  is  given  by 


E(t)  s  P(tlt)HT(t)R'‘(t)  (2.11) 

and  the  error  coverlanoa  le  obtained  ee  the  solution  of  the  intrix  Rloatti  equation 

7"P(t|t)  •  P(t)P(tlt)  +  P(t|t)PT(t)  +  «(t)  -  P(tlt)HT(t)R'l(t)H(t)P(tlt)  .  (2.12) 


2.1.2  77m  Innovations  Approach 

A  more  rigorous  derivation  of  the  eolutlon  of  the  llnstr,  unbiased,  einimum  verlsnee  filtering  problem  Is 
prtesntsd  In  this  ssotlon.  The  approach  follows  that  of  Killath1'  and  has  s  strong  similarity  to  the  derivation 
preeented  by  Kalman  and  Buoy  In  their  original  paper1'. 

To  begin,  the  properties  of  tbs  residual  £(t)  defined  in  Equation  (2.2)  will  be  examined  In  more  detail. 
Kallath  refera  to  thle  prooees  ee  the  innovation*  p roast  because  the  residual  contains  in  eaatneo  the  "ns*” 
Information  contained  In  ths  measurennt  data  g(t)  . 

77m  process 

£<t>  =  l(t)  -  H(t)g(t I t) 

is  a  nhite-noiu*  proem  with  the  same  statistic!  as  tin  measurement  noin  pro  csss  x't)  when  |(tlt)  is  ths 

minimum  variance  estiaate  of  j(t)  using  5(t)  . 

%  4 


The  plausibility  of  tills  statement 
noise  process. 

can  be  seen 

by  direct  calculation. 

First,  verify  that  £(l)  la  a  whits- 

Ut 

£(t) 

A 

H(t)j(t)  . 

(2.13) 

Then 

£(t|t) 

a 

H(t)i<t it) 

' (2.14) 

and 

{(tit) 

a 

IKt)X(tlt)  ; 

(2.  IB) 

to 

£(t) 

- 

«(t)  -  {(tit) 

a 

H(t)|(tU)  +  y(t)  . 

(2. 10) 

Suppose  t  >  i  .  Uslnt  Equation  (2.16),  fora 

E[£(t)£T(S)]  =  E[£(ilt){T(sls)]  +  E[x<t)£T(sl*>]  +  E[g(t  I  +  E[v(t)xT(«)] 

Blnoe  v<t)  la  a  whlte-nolee  process, 

E[x(t)JT(s)]  a  0 

and  Ell(t)3!T(»)]  *  0  . 


Corteequent  ljr 


*(£<t)iT(a)]-  *  l{j(tlt)[jl(ala)  +  j(»)]T) 
*  i{j(t it)  Eb(»>  -£(•)] T)  . 


But  It  ia  wall -known  that  tha  arror  {(tit)  for  the  minimum  variance  estimate  auat  b«  orthopjnal  to  tha  measure - 
aanta  5(a)  In  tha  atnaa  that 


E[{T(tlt)*(a)]  *  0  .  a  <  t  , 

Thia  proparty  la  provta  in  Saotlon  2.1.3  and  la  aaaantially  tha  Wlanar-Hopf  aquation. 


(2. 17) 


Aaauain*  that  J(tlt)  ia  a  linear  function  of  tha  aaamiraaent  data  5(t)  and  la  tha  alnlaun  variance  estt- 
aata,  It  follows  from  Equation  (2.17)  that 


*Ct<t)cT(a)]  =0  for  t  >  a  . 


A  alallar  argument  for  t  <  a  jhowa  that 


BCt<t)tT(a)3  a  o  for  t  <  a  , 


ao  It  only  raaalna  to  oonaldar  t  a  a  .  It  la  naotaaary  to  daaonstrata  that  E[t(t)£T(t)]  la  Infinite  In  ordar 
to  oonoluda  that  £(t)  ia  a  whlta-noiaa  prooaaa. 


*tt(t)£T(t)]  -  E[r(t)iT(t>]  +  E[{(tlt){T(tlt)]  +  l[v(t){T,(tlt>]  +  l[{(tlt)vT(t)]  . 


lut  {(tit)  la  defined  aa  tha  arror  In  tha  aatinata  of  jrft >  for  tha  data  z(s)  ,  t,  <  i  <  t  and  v(t)  la- 
whlta-noiaa,  ao 


■  tl<tlt)XT(t)]  a  0  a  E[v(t){T(tlt)] 
*t£<t>£T(t>]  =  R(t)S(t-t)  +  E[{(tlt){T(tlt)]  . 


lut  the  cover  ienoe  El{(t|t){T(tlt)]  la  finite  ao  it  Is  nailliibla  by  oonparlaon  with  R(t)$(t-t)  and  one 
concludes  that 


E[£(t)£T(a)]  a  R(t)5  (t  -a)  . 


Tha  residual  £(t)  rapreeante  tha  difference  batwaan  tha  new  saaauraiaent  j(t)  and  the  prediction  based  on 
all  previous  data  {(tit)  .  Thus  £(t)  contains  tha  Information  bains  contributed  by  tha  j(t)  ,  so  £(t)  and 
|(t)  can  be  used  lnterchanseably.  Suppose  that  tha  optimal  estimate  ia  a  linear  function  of  the  Innovations 
process  and  has  the  fora 
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i(tlt)  =  J*  W(t.»)t(»)  d»  .  <2. 18) 

'*o 

where  W(t,»)  Id  to  be  chosen  in  that  Equation  (2.17)  la  satisfied.  Fora 

Kti(tU)tT<ff)l  =  *(t18)EEc(B)tT(°')]  d»  ■ 

*o 

Uaini  the  orthogonnltty  of  the  error  in  thn  estimate  and  the  measurement  data,  one  obtains 

E(St<tlt)tV)]  =  K[s(t)i;T(o)l  . 

From  the  whlte-nolso  property  of  £(s)  ,  it  follows  that 

Etl(t)CTMl  =  W(t,o-)R(cr)  .  ts  <  a  <  t  .  (2.12) 

Since  R(tr)  la  poaltlve-definltc,  the  wrlfhtlnf  matrix  cm  bo  determined  and  the  estimate  la  liven  by 

i(tlt)  r.  ftF,[S(t)cT(s)]R-1(S)r(e)  de  .  (2.20) 

'*0 

The  Kalmen-Bucy  filter  equations  presented  In  ths  pradadlng  lection  are  obtained  from  Equation  (2.20)  by  dlfforen- 
tlstlni  with  respect  to  t  and  by  usini  Equation  (1.1). 

Differentiate  Equation  (2.20)  to  obtain 

d  ft  d 

—  i(tlt).  S  E[x(t)tT(t)]Vl(t)c(t)  +  —  ECi(t)tT(a>lR-l(e)C(a)  da 

dt  J+,  at 

la 

*  lts<t)it(t)]R“l(t)i;(t>  +,F(t)  j"  ltj(t)tT(s)lR"(i)r(a)  d«  +  ]* S [a(t)c'r (*)] R* 1  (a)£(»)  da  , 

Jto 

But  the-eeroond-term  -ia-  equal  to  Vft-l&ttlt)  and  .the  .plant  noise  and  residual  are  Independent,  so  this  reduces  to 

i(tlt)  r  F(t)i(tlt)  +  E^(t)IT(t)]B’1(t)£(t)  . 

Lettlw  K(t)  d  E[»(t)rT(t)]R*l(t)  ,  (2.21) 

the  differential  equation  assumed  in  Section  2.1.1  le  obtained: 

i(tlt)  *  Kt)J(tlt)  +  *<t)[s(t)-H<t)g(tlt)]  .  (2.3) 

Consider  t[&(t)£T(t)]  and  observe  that 

E[x(t)£T(t)]  E{j(t)  [H(t)i(t!t)  +  v(t)]T> 

=  *{CX(tlt) +  i(fc!t)]ST(tlt))HT(t) 

=  P(t I t )HT(t )  ,  .  (2.22) 

since  the  estimate  and  error  are  orthoional  and  P(tlt)  i  E[g(t!t)gr(tlt)]  . 

The  error  oovtrlence  matrix  is  specified  by  deriving  the  matrix  differential  aquation  that  it  must  eatlsfy, 

This  le  accomplished  by  different  1st  ini  P(tlt)  and  using  the  ieln  established  by  Equations  (2.21)  and  (2.23). 
Thata  operationa  art  similar  to  the  discussion  or  Sactlon  2.1.1  and,  as  expected,  yield  the  result  obtained 
there.  Bore  specifically,  P(tlt)  la  the  solution  of  the  matrix  Rloatti  aquation 

P  =  r(t)P  +  PfT(t)  -  FHT(t)R''(t)H(t)P  +  «(t)  ,  (2.12) 

share  it  has  bean  shown,  uainr  Equations  (2.21)  and  (2.22).  that 

K(t)  *  P(tlt)Hr(t)R"l(t)  .  (2.11) 

This  coapletaa  the  derivation  of  the  Kalstn-Bucy  filter  by  the  innovations  approach. 
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2  t.J  Other  ComiJerat  ioni 


Thero  are  many  other  aspects  that  could  he  considered  In  conjunction  with  the  problem  discussed  In  the  pre- 
oedlni  lections.  Some  of  these  will  be  treated  In  this  sect  Inn.  In  Soctlon  2. 1.2  the  orthogonal lty  of  the 
optimal  linear  estimate  and  the  associated  error  was  used  without  proof  and  this  will  now  bo  supplied.  Also, 
thw  general lr.nt Ion  to  the  ease  In  which  the  plant  and  mcesuramunt  noise  processes  are  correlated  la  discussed, 
ss  la  the  effect  of  a  deterministic  forcing  function  In  the  plant  model  (e.g.,  arising  frum  control  system 
considerations) . 


2. 1.3.1  Orthogonal  projection  anti  the  I Viener-ltapf  ctjuation 

The  orthogonality  condition  (Eqn  (2.17))  used  In  Seatlou  2.1.2  Is  e  spnulsl  esse  of  the  geometric  property 
of  orthogonal  projection.  Since  the  estimate  Is  a  linear  function  of  the  measurement  data,  It  ie  contained  In 
the  linear  eubapace  spanned  by  those  data,  if  the  state  vector  la  not  contained  In  this  subspnoe,  It  le  clear 
that  the  error  in  the  estimate  will  not  vanish.  In  fact,  the  error  will  have  lta  smallest  magnitude  when  the 
estimate  la  taken  as  the  orthogonal  projection  of  the  atate  on  the  subspneo  spanned  by  the  measurement  date. 
This  Ides  will  be  made  more  precise  below  and  then  applied  to  derive  the  well-known  Wiener -Hopf  equation  and 
the  orthogonality  conditions  used  in  the  preceding  soctlon. 

Consider  a  linear  npace  X  such  that  an  Inner  product  (j,  jr)  in  deflnod  for  any  two  elements  j. ,  y  In  X  . 
Doflne  a  norm  by 


IUII  =  <S.  S>*  • 

Lit  I  be  i  auhapaca  of  X  and  consider  the  problem  of  finding  a  veotor  £  in  M  which  minimises  lli-jll 
with  respect  to  any  {(M  .  The  solution  of  this  problem,  If  It  exliti.  ‘.a  given  by  the  following  rsiult. 

Orthogonal  Projection  heeuea:  |lj-£||  la  a  minimum  for  all  JIM  , 

ll»-Zll  >  Ill-til  '  for  all  Z«M  , 
if  and  only  if  (j-£)  i«  orthogonal  to  all  gcM 


(i-£,2>  a  0  for  ml  1  jrs*  .  (2.23) 

Thus,  the  c*n  b*  regarded  an  tha  linear  combination  of  the  elements  spinning  M  (e.g.  thg  measurement 

data).  This  estimate  yields  nin  error  that  it' orthogonal 'to  all  elements  jr  c  *  . 

The  proof  of  this  result  la  straightforward.  Assume  that  Equation  (2.22)  is  valid,  Then,  for  any  Z(M  , 

lli-xll*  =  ii  <* -£>  +  (£~r>il* 

=  l|S-ill*  +  2<S-£,  i-t)  +||£-Z||’  . 


But  <£-Z)  (M  :  so,  by  Equation  (2.29),  tha  mlddls  harm  vaniahta  and 

Hi-iH*  =  in-in*  +  lli-xll* 

>  iii-iii* 

with  equality  if  and  only  if  j  =  £  • 

To  oomplats  tha  proof,  assume  that  £  minimize*  || j- jrll  for  all  •»!  that  thare  exists  some 

Zl«H  euoh  that 

<l-£.£i>  *  *  *  0  ■ 

Than  lll-i-/9Xl||«  =  Hj-ill*  -  7.0./3  +  /fl'llgjl*  . 

But,  by  appropriate  oholce  of  P  ,  it  is  poaiible  to  make  tha  last  two  terms  nagatlva,  thereby  oontradJctlng 
the  minimality  of  9  . 


The  orthogonal  projeotlon  leans  oan  be  used  to  derive  the  Wiener-Hopf  equation  and  aasoelatnd  orthogonality 
conditions  for  the  estimation  problem  desoribed  In  Section  1.2.  Let  X  be  tha  n-dlmenalonal  state  apace  and 
define  the  Inner  produot  of  two  elements  in  X  to  be 


'  (J,i>  n  E[jT2l  .  for  all  j  ,  . 

Cor  convtnlanca,  it  will  be  assumed  that  the  variables  all  hava  zero  mean.  The  norm  of  j«X  la 

lljll2  =  <x.l>  =  E[gTj]  »  trace  e[j&t]  . 
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Frun  the  crthoioiial  projection  lemma,  the  traoe  of  tho  error  oovarlanoe  matrix  la  minimized  If 

(j(t>-J(tlt>.  J(e)>  =  E[sT(tlt)i(a)]  =0,  for  t,  <  a  <  t  .  (2.24) 

Similarly,  thle  lemma  le  tried  to  aatablli.h  Equation  (2.17)  and  the  othor  orthogonality  conditions  used  In 
Seotlon  2.1.3. 

To  derive  the  Plener-Hopf  equation  for  the  nonntatlonary  linear  aystem  of  this  presentation,  auppose  that  an 
estimate  of  the  stato  j(t)  la  to  be  a  linear  funotlon  of  the  measurement  data  g(t)  having  tho  form 


Sift  It)  =  W(t,  s)s(s)  ds 


‘  .v.Vf 

.  •*.*<  >,y 

\a  *  a'  .  • 


to  I 


Since  tho  components  of  jl(tlt)  oan  bo  chosen  Independently  of  each  other,  It  suffices  to  chose  S(tlt)  so 
that 

E{[j(t)  -S(ttt)]sT(s)}  =  0,  t„  <  s  <  t  . 
tls In |  Equation  (3.2S).  one  obtains  the  Wlener-Hopf  equation 


«[j(t)tT(e)]  *  /tW(t,o-)E[ji(o)8T(s)]  dcr  for  t,  <  s  <  t 
tn 


2. 1.3.3  Correlation  between  plant  and  aeaiuraeent  noise  processes 


It  bee  been  assumed  heretofore  that 


E[»(t)jr*(s)]  =0  for  all  t  ,  s  . 


In  thle  eeotlon,  oonslder  the  more  general  case  In  which 

E[w(t)XT(s>]  =  C(t)S<t-i)  for  all  t,e.  (3.37) 

Relative  to  the  development  df  Section  2.1.1,  note  that  the  effect  of  the  correlation  appears  flrbt  in  the 
derivation  of  Equation  (2.2).  One  sees,  In  thle  aase,  that 

K[j(t)JT(tlt)]  *  i R(t)KT(t)  +  +  0*(t) 
and  *Ca<t)IT(t lt)J  <=  iQ(t)  -  iC(t)KT(t)  . 

Consequent ly.  Equation  (2.3)  le  found  to  be  modified  and  tha  differential  aquation  deaeribini  the  error  covari¬ 
ance  matrix  becomes 

—  P  a  [P(t)  -K(t)H(t)]P  <■  P[E(t)  -K(t)H(t)]T  +  Q(t)  +  K(t)R(t)KT (t)  -  K(t)CT(t)  -  C(t)KT(t) 
dt 

=  P(t)P  <■  PPT(t)  +  0(t)  +  {K(t)R(t>KT(t) -K(t)[lI(t)P  +  CT(t)]  -  [PHT(t)  +C(t)]KT(t)>  .  (3.28) 


The  optimal  (tin  matrix  te  found  to  be 


1  K(t)  =  [P(t  1 1  )Ht  (t )  +  C(t)]R"l(t)  <2.29) 

end  the  optimal  error  cover  lance  Is  descrlbsd  by 

P  r.  f(t)P  +  PET(t)  -  [PHT(t)  +  C(t)]r‘[CT(t)  +H(t)P]  +  Q(t)  .  (2.30) 

Th«  iim  raiult  is  obtilntd  usini  tha  innovations  approach  whara  Equation  ($.22)  is  modified  to  aooount  for 
ths  eorr alat ion. 
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3. 1.3. 3  Oeterminietic  plant  forcing  function 
Suppotia  that  tha  plant  modal  Is  alt.avad  to 

i  =  P(t)*  +  Il(t)  +  H  .  <*•**) 

Share  g  le  a  blown  funotlon.  The  only  modification  required  to  the  filter  aquations  In  this  caas  is  to  nots 
that  ths  prediction  must  account  for  g(t)  .  Thus,  the  estimate  le  zlven  by 


.’A>V'-V*VwV*\ 

■y->\ 


v%  V.'  -  ‘e”"  O 

W-  '.-'.yANY'-y. 
‘v’  -.T*,’’  \ 


i  -  Fft)8  +  fl(t)  +  K(t)[*(t>-H(t>i)  , 
whero  K(t)  and  F(tlt)  are  unchanged  from  Equations  (2.11)  end  (2.12). 
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(2.32) 


2.1..?.  4  Conditional  man  and  ninimnn  variance  istimtu 

The  minimum  variance  estimate  has  an  Interesting  lnteriirotstlan  In  terms  of  the  conditional  density  of  the 
state  j(t)  ilvim  tho  measurement  data  2(t)  .  This  relation  Is  described  In  tha  following  lemma. 

lemma.'  Duppose  that  a  random  variable  £  la  to  bo  estimated  from  measurement  data  2  and  suppose  that  £  and 
2  have  the  Joint  probability  density  function  p(j,2)  .  An  estimate  £  Is  to  be  determined  from  tho  data  2 
so  that 

e[(Z-&)t(£-8)]  =  minimum  . 

Then,  the  minimum  variance  estimate  |  is 


&  -  E[glg]  .  (2. 33) 

Proof :  Writ*  l[(g-i)T(i-i)]  In  terms  of  the  conditional  donslty,  using  the  identity 

E[(i -'$)’<£-$)]  =  E(E[(£-|)T(i-i)l2]>  . 

But  Rl'U-i)T(S-i)IZ]  *  fi  -  2|TE[£l2]  +  E[|T£lZ] 

-  <i-K[gl'2l)T(i-E[il2J)  +  ttl’tlZ)  -  Et[sIz]b[£i2]  .  (2.34) 

By  definition  this  quantity  is  positive;  so,  to  minimize  e[(x - |)T (J -  t)]  ,  It  la  auffiolant  to  minimize 
Equation  (2.34).  Only  the  first  term  involves  £  and  It  Is  quadratic  so  that  the  smallest  value  It  can  assume 
la  aero.  Thle  obtaine  whan 


S  *  BCilal  : 


■o  Equation  (2.33)  is  proven. 

Note  aleo  that  th*  conditional  nan  provloea  an  unblasad  est lasts  of  &  .  This  fellows  easily  by  recognizing 
that 

Etfl  a  E{E [glZ]')  -  E[»l  . 

For  the  linear  system  (tqns  (l.l)  -  (1.2))  and  t(ia  gausalan  character  of  the  initial  stata  and  the  noise 
prooeaaea,  it  follows  that  &(t)  Is  gauaelan  for  any  time  t  .  Further,  It  can  ba  shown  thet  the  conditional 
density  of  the  state  j(t)  ,  given  the  data  2(4)  .  1«  gauaelan  with  swan  value  and  oovarianoa  daacrlbad  by 
Equations  (2.3),  (2.11).  and  (2.12).  Thus,  the  Kalmsn-Buoy  estimate  describes  th*  behavior  of  tha  mean  end 
eovarlanoe  of  the  conditional  density  function.  Aa  a  result  of  this  fact  and  tha  lamma  proved  above,  the  linear 
Kalaan-Buoy  equations  provide  the  beet  estimate,  even  when  nonliueer  estimators  art  considered.  Probabilistic 
aapeots  of  the  eetlmatlon  problem  are  considered  in  depth  in  Chapter  8. 

2.1  4  7Jie  Time-Dieerete  Problem 

Tha  tlma-dlaorate  linear  filtering  and  prediction  problem11  is  included  for  th*  sake  of  eomplet*nese  and 
raaults  era  stated  without  proof'.  Mora  details  oan  be  found  in  Beftranoea  19  and  20  or  Chapter  S  of  this  book. 
One  oan  use  argument*  that  are  very  similar  to  thoae  uaed  in  the  preceding  aeotiona  and  tha  ravulta  contain  faw 
surprises.  Tha  prinolpal  difference  resides  In  the  fact  that  the  measurement  nolae  eovarlanoe  matrix  does  not 
hav*  to  be  positive-definite,  although  a  related  matrix  must  have  this  property.  No  attempt  will  be  made  here 
to  treat  tha  tlM-dlaorsta  problem  axhauetively.  Most  results  for  the  time -continuous  oese  oan  be  eodtfled 
without  difficulty  to  apply  to  this  problem, 

Consider  a  system  whoa*  state  la  described  by  a  linear  diffarenoa  equation 

jk  a  ’•’a.k-iSg- 1  +  Sg-i  .  k  =  1,  2,  ...  (2.38) 

and  which  la  observed  through  measurement  data  zt  obtained  at  discrete  inatanta  of  tin  tk  .  Thaet  data  era 
assumed  to  ha  llntarly  ralated  to  tha  state  according  to 

*k  =  NgSg  +  '  (2. 38) 

Tba  noise  sequences  ere  assumed  to  be  gauaelan  and  uncorralated  between  sampling  instants  (l.s.  white-noise 
sequences)  with  zero  Mens  and  covariances; 


“tSfcSj]  =  Vkj 

=  VkJ 

Etw^yJ]  =  CkJkJ  . 

The  \  end  »k  trc  aasumod  to  be  uncorrelated  with  the  Initial  state  ja  ,  which  la  a  gauaslnn  random  varlublo 
with 

BCxJ  =  *0 

Ef(i0-4(  >  >T)  -  M„  . 

For  this  eyutcm  one  can  prove  that  the  unhlasud,  mtn,  •  vnrlance  estimate  of  jk  ,  *lven  the  data  2(k)  ,  la 
deiorlbed  by  the  following  system.  The  estimate  of  the  state  xk  is 

H  -  +  *k-i  (?k-i  "*'k-i*k-J  (2.37) 

before  the  maaaurament  gk  Is  processed.  The  estimate  when  Ek  la  Included  la  obtained  by  modifying  the  pre¬ 
dicted  estimate  J|j  according  to 

3k  =  Ik  '+  *k  [Ek  -HkXkl  ■  (2. 38) 

The  opttsMl  gains  Ak.,  and  Kj,  are  givon  by 

Vi  s  ck-i  ^Hk-tpk-tHla-i  +  ''b-l^"1  (2.38a) 

K„  *  Pfc'Hj +  Rkl‘l  .  (2.39b) 

where  the  predioted  error  covariance  matrix  Is  described  by 

pk  “  **li- i*J. k- 1  +  Vi  ”  ^t,k-i  lth-i  ck-i  “ 

-  Ck-i^-i^h-i  “  Vi  C«lt-ipk-.«k-,  +  (»■«> 


end  the  ourrent  error  oovarlanoe  eatria  le 


pk  ■  K  -  Wi  ■ 


When  the  plant  and  neaaureaent  noise  are  uncorrelated,  the  eatria  Ck  vaniehes  and  oauees  Ak  to  vanish 
end  the  oovarlanoe  eatrloea  reduce  to 

K  3  Vk.iVA'k..  +«a-i  <a« 

and  Pg  *  Pk  -  KkHkPk'  ,  (2.43 

Note  that  the  gain  matrix  raqulrai  the  Inversion  of  fyPjHj  +  Rj  instead  of  the  mesaurement  oovarlanoe  matrix 
Rk  ,  aa  oooura  In  tha  tlm-contlnuoua  case.  Hcwevar,  one  can  derive  e  form  for  IL  that  le  more  almllar  to 
Section  3.1:1  when  P|J  and  ara  poiitlve-deflnUe  by  making  use  of  the  following  lemma. 

Matrix  Inversion  Ltmxa:  suppose  the  nan  matrix  B  and  the  ixa  aatrlx  R  ere  poeltlve-deflnlte  end  let 
H  be  en  arbitrary  man  matrix.  If  A  le  given  by 

A  a  B  -  BHt[HBHt  +  r]"1HB  .  (2.44 


th«n  the  Inverse  of  A  is 


AM  3  B-‘  +  HTR'*H  . 


The  proof  follows  by  aultiplloetlon  of  A  and  A'1  . 

The  error  oovarlanoe  matrix  oen  be  rewritten,  by  substituting  Equation  (2. 43)  Into  Equation  (2  43), 

Pk  a  p'  -  ^H;(HkPk'HkT  +  Rk)-V'  . 
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Ua Ins  tho  lemma,  one  obtain* 


The  (alii  matrix  o*n  also  be  modified: 


PJ1  =  (P||)M  *  . 


ltk  s  • 

But,  from  Equation  (2,43), 

pi‘Pk  =  1  +  "XVa  • 

*0  Kk  =  P^[I  +  [1  i-H^'lljRj;1]'1 

‘  Pk'{l*;1  (2.4B) 

Equation*  (2.47)  and  (2 . 48)  provide  an  alternative  form  when  Pk  and  Rk  are  poeitlvo-dof lnlte.  Equation  (2.47) 
haa  the  dlaarivnntnce  that  an  n<n  matrix  must  bo  inverted,  lather  than  tho  matt  matrix  that  must  bo  lnvertud 
in  Equation  (2.42)  (usually,  m  <  n). 

2,1  The  ColoreU-Notaa  Problem 

2,  2.  i  Ooloud-Noil*,  Shaping  Filters,  and  State  Factor  Augmentation 

It  haa  been  aaauaied  that  the  plant  and  meuaurtmnnt  note*  proceaaea  are  lauaalan  and  white.  This  aaaumption 
le  not  always  aatlafled  In  praotloe,  ao  It  la  deilrablt  to  oonaider  linear  ayatana  in  which  the  note*  exhlhlta 
correlation  between  different  inatanta  of  timed.*,  the  noiae  1*  "oolored").  Thl*  problem  la  auooeeafully 
approached  when  tho  noiae  can  be  deacribed  by  a  ahapini  filter11. 

Dtfinition :  Coneldar  a  (auaalan  random  prooeae  jj ( t )  that  haa  aero  man  and  whoae  aeoond-order  correlations 
are  f Ivan  by 

*Ca(t)ttT(r)]  s  D(t,r)  .  (2. 42) 

A  linear  dynamical  ayatem  driven  by  a  lauaalan  wblte-noiae  prooaaa  whose  output  haa  the  aame  atatlatloa)  oharao- 
teriatica  aa  Q(t)  la  oalled  a  ahapini  filter, 

Thus,  by  lntroduoini  a  ahapini  filter,  many  random  proceaaea  p(t)  oan  be  deaorlbed  by 

&  »  A(t)|  +  1  ,  (2.50) 

(■' 

there  A(t)  and  the  atatlstlci  of  the  white-nolae  w(t)  are  choeen  ao  that  n(t)  haa  the  preaorlbed  atatlatloa. 
The  problem  of  dotermlnlni  ahrplni  flltera  for  random  proceaaea  will  not  bo  traated  here,  but  the  filter  develop¬ 
ment  for  thoae  proceaaea  deasribablt  by  Equation  (2.50)  will  be  liven  below. 

Consider  the  followlni  linear  nyatein  (analoioua  to  Equation*  (1,1)  and  (1,2)),  in  whioh  oolored  nolee  exists 
in  the  plant  and  msaeurement  aystema.  To  dietlmulah  between  white  and  colorad-nolae  components,  consider  the 
follovlni  partitioned  ayatam. 


p^t) 

P,!t) 

r,(t) 

P,(t) 

where  *t  le  a  white-nolae  prooaaa 
£t  la  a  colorad-nolae  procaaa 


and  la  a  whlta-r.oia*  prooeaa. 

The  meaeuremnt  data  are  daaorlbed  by 

M 


ti  ■  »tt>f ,  *  !, 


H,(t)  H,(t) 

H,(t)  H,(t) 


H-vuiWto,  yyWsH 

'.“V  » 

a'*  b  Im'.h 

d-  ‘ 

k*  '**y  *11  ti 

i-d-. 

»  “  4  -  *  ■  '  m  r  a.  ■ 

k'e'.'w'm  4kV  „  » 


•./<  .•av.--  ..  -v.  J 
< 

w-T-e. I*r*  14 


C--VA.V.n-< 

"  *  ■  “  *  ■  _  ■  • 

a  *  *  *  - .  •  -  -  I 


, '  w  ,  i 

ms".  J* 


i*!*v 

>■’  •'  '‘-.t 


‘  *>»•  \*  v*  U 


■  >  -w* 


16 

where  j,  U  >  *hltt>-nolna  process 
li  a  oolor*d-nnl»*  procee* 

"her*  £,  *  B(t).*,  +  g,  (2.54) 

and  «,  la  a  white-noise  prooesa. 


The  problem  deecritied  by  Equation*  (3.51)  -  (S.  84)  can  bn  reformulated  by  itnte  vector  augmentation  to  obtain 
a  nyetem  In  »hloh  tha  atate  variablae  ?,  and  ara  combined  with  the  oolorad-noiee  varlahlce  and 
to  define  a  ayatem  in  which  only  white-noise  appear*  explicitly.  Thie  eyatom  in 


with  Maaurement  data 


or,  .acre  euocinotly, 


—  * 

il 

~F,U) 

F,(t) 

O 
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V 

Si 

i. 
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F,(t) 

r,(t) 
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B(t) 
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-H,(t) 
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Hj  (t) 

H,(t) 
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0 

>1 
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j  “  r<t)2S  +  I 


(3.50a) 


(3.06a) 


<3. 00b) 


8  •■•»(«*•+ J(  .  (3  06b) 

»h«re  ST  $ 

eith  alailar  definition*  for  P(t)  ,  H(t),  g  .  and  'i  Thua,  it  appear*  that  the  problem  hue  been  reformu¬ 
lated  to  tha  model  (Ivan  initially  by  Equation*  (l.i)  and  (1.3),  ao  that  the  volution*  already  obtained  nan  be 
applied.  Unfortunately,  thie  1*  not  true  became  the  aero  component*  appearing  in  the  naaeurement  noli*  vector 
X  prevent  the  oovarlanoe  matrix  lift)  from  being  poaltlve-dofinit*.  Thla  property  le  required  in  order  to 
form  the  optimal  gain  matrix  K(t)  ,  elnc*  R‘l(t)  la  required,  Thua,  ahaplng  filter*  and  atata  vector  aug¬ 
mentation  permit  the  plant  equation  to  be  rewritten  in  a  manner  that  le  compatible  with  our  previoue  result* 
(l.e.  th*  plant  covarlanoa  matrix  q  doaa  not  have  to  be  inverted)  but  edditlonal  consideration  mu*t  be  given 
to  colored  measurement  noise. 


3.2.2  Saluiion  for  Colored  Meaeurement  No  it* 

The  component*  of  th*  measurement  vector  which  contain  only  eolored-nolsi  provide  th*  source  of  i  he  difficulty 
In  applying  the  filter  equations  developed  earlier.  This  problem  was  first  discueeed  by  Cox"  end  Bryson  end 
Johansen11  and  has  more  recently  been  considered  by  Buoy'*,  Steer  and  Itubberud1*.  and  Saracblk1*.  To  develop 
a  solution  for  thie  oeae,  ilium*  that  th*  model  has  th*  form 


&  “  ><t)j  +  s 


(3. 87) 


end 


II 

• 

’  H,(t) " 

s" 

m 

&  + 

H,(t)_ 

0 

where  j  le  an  <n  +  p)  dimensional  etate  vector 

gt  is  an  m-dlmnaional  measurement  vector  containing  additive  ehite-nolse 
j,  is  e  p-d loans lonsl  noise-free  measurement  vector 

Thla  modal  is  motivated  by  Equations  (3.56)  and  (3.56),  although  P(t),  II, (t)  ,  end  H,(t)  will  not  be  required 
to  hnv*  the  form  given  there.  The  whlte-noli*  v  la  tniumed  to  have  t  positive-definite  ooverlenoe  matrix  R(t) 
end  th*  H,  end  H,  tr*  assumed  to  have  maximal  rank. 
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There  are  several  aapsots  of  this  problem  that  raqulre  mention.  First  observe  that  one  might  solve  thn 
problem  formslly  by  differentiating  the  measurement  data  j,  : 

t,  -■  H,i  +  11,1 


-  (H,F+H,)X  v  II, B  . 


(2. 88) 


If  H,QllJ  (l.e.  the  covariance  matrix  of  tbo  noise  vootor  H,b)  In  posltlve-diiflnlte,  then  oan  be  trestod 
ii  the  measurement  dots  In  place  of  2]  since  thoy  sre  equivalent  If  the  In  It  1 u 1  omul  It  Ions  on  j  sre  solocted 
sppropr lately.  Now  the  Knlman-Bucy  results  oan  bo  applied  using  tho  measurement  dnta  and  J,  .  If  H,QHj 
has  rank  r  <  p  ,  then  ono  oan  transform  tho  Into  a  vootor  that  Is  separated  Into  coeiponents  either  with 
or  without  whits -noise.  The  notse-free  components  osn  be  differentiated  again  In  an  attempt  to  Introduce  white- 
noise.  The  procedure  of  sopnratlon  nnd  differentiation  can  bn  repented  until  s  set  of  p  mousurcmuntH  contain¬ 
ing  whito-nolse  aro  generated  to  replace  J,  .  If  It  proves  to  bo  lmyonsiblo  to  lntroduoo  wliltc-noleo  Into  every 
component,  ihon  thoso  "perfect11  mensureeiontn  oan  be  doalt  with  a"  described  by  BryF.cn  slid  Johnnson’1 


Note,  however,  that  tbo  nolHe-free  mousurementM  In  Equation  (P.Bfl)  provide  perfect  knowledge  of  P  vnrlnhles, 
so  that  one  would  expect  that  the  flhor  equations  would  only  Involve  n  variables  instead  of  tho  (n  t  p)  npponr- 
lng  In  the  state  vector  of  Equation  (I. (57).  This  permits  a  desirable  relaxation  of  computational  requirement!). 
Furthermore,  It  Is  undesirable  in  practice  to  differentiate  data,  so  these  two  dlsRdvantsgss  motivate  ono  to 
develop  other  moans  for  dealing  with  colored  measurement  noise, 

Using  the  definition  of  g,  and  the  assumption  thst  H,  has  maximal  rank,  It  is  possible  to  define  an 
(D-p)il  matrix  II,  auoh  that  a  nonelngular  matrix  T ft 5  ,  with  t  >  t9  ,  nan  bn  formed. 


T(t)  6 


H,  (t) 
H,(t) 


(3,00) 


The  H,  must  be  selected  so  that 

H,Hj  =  0 

and  H,Hj  «  I  . 

Ths  task  of  choosing  H,  Is  not  ss  difficult  sa  It  may  ,»t  first  appear;  at  least  It  Is  trivially  accomplished 
for  an  Important  class  of  systems  that  are  dlsousatd  later  in  this  amotion. 

Let  the  Inverse  of  T  be  defined  ss 


r'(t)  =  [j,(t)J,(t)] 

where  It  oan  easily  be  shown  that 

J,  =  hJ(H,hJ)‘‘ 
J,  =  »] 


whan  tha  oonstralnts  on  H,  are  Invoked. 


Define  new  state  variables  with  subveotors  g,  and  £  such  thst 


*  *  T» 


Since  T  has  an  Inverse,  the  j  oan  be  recovered, 

l  =  J,s,  + 


(3,61) 


(2.63) 


(3.03) 


tut  g,  Is  known  measurement  data,  so  the  problem  of  obtaining  the  minimum  variance  estimate  of  &  reduoee  to 
that  of  eatimatlni  £  .  Aa  a  rtault,  ths  order  of  the  filter  thst  ia  required  reducee,  aa  expected,  'rom  (n  +  p) 
to  n  .  Aftor  the  estimate  of  £  la  determined,  the  estimate  of  the  state  2  1"  obtained  from 

£(tlt)  =  J,(t)j,(t)  +  J,(t)£(tlt) 


(2,84) 


Consider  tho  probluin  of  ehUmntimi  the  voctur  ^  .  From  Equation  (2.03).  It  1h  mien  that 


6  “  M  . 

•a  a  differential  equation  describing  £  la  obtained  by  different luting  and  substituting  Eqmitlon  (2.67): 

i  -  H]!  +  H,j 

=  (A,  ♦ll1F)S  4  HjR 

=  [(II,  4H,F>J,]£  *  (A,  +  M,P)  J,2,  4  II,  »  .  (2.05) 

The  term  (H,  +  ll,F)2,I,  1"  a  known  forcing  function  «a  It  can  hu  treated  In  the  fashion  described  In  Soctlon 

5. 13  3. 


The  measurement  data  Jj  can  also  be  expressed  'll)  terms  of  £  : 


z,  =  H| •»,?.,  4  V,£  4  y  . 

ut 

2  x  St  -  V»S»  : 

(2. GO) 

•0 

8  =  tV,l£  +  Y  • 

(2,07) 

Equations  (3.83),  (2.68),  and  (2.67)fora  a  system  to  which  the  previously  derived  filter  equations  can  be 
applied,  alnoa  x  la  assumed  to  have  s  positive-definite  oovarlnnoe  matrix.  One  point  remains  to  be  defined. 
Ordinarily,  etatletloe  are  prescribed  for  &(t,)  ,  but  In  this  application  It  It  necessary  to  specify  statistlos 
for  £(tc)  .  To  accomplish  this,  e  that  the  measurement  s(t„)  Is  known;  so  it  otn  be  usod  to  eetlmnte 
j(t0)  and,  through  Equation  (2,0.  to  obtain  Initial  conditions  for  {( t„i  .  Unihg  tho  ranults  for  time- 
discrete  filtering  presented  in  Bsc  ion  2.1.4,  one  sees  that  the  statistics  of  £(t0)  ,  based  on  tils  a  priori 
statistlos  fur  £(t0)  and  the  noise-free  measurement  data  3,(t0)  ,  are 

£<t„>  =  H,<t#)i<t0lt0> 

«  Hjft^PajJHjft^CH.ft^Pd^Hjd^l-'gjtt,,)  ,  (3.68) 

with  error  oovirlanoe  matrix 

n<t0)  x  »l,(t0) [P(t„) - K(t„)Ha(t0) P(t0)]Hj(t0>  ,  (3,68) 

where  the  gain  matrix  li  given  by 

,  K(t0)  =  P(ta)Hj<ta>[H,(to>P(t0)Hj  .  (2.70) 

Naturally,  It  la  necessary  to  assume  that  the  Inverse  of  H,(t0)  P(t0)Hj(t0)  exist*  for  thee*  relstlons  to  be 
valid.  Sino*  H,  has  already  been  aaaumad  to  have  maximal  rank,  It  In  auffioient  to  raqulrs  that  P(t0)  be 
positive-definite,  although  this  la  not  a  necessary  condition. 

Using  the  Initial  oondtttona  (Eqns  (2.68)  and  (3.68)).  tha  minimum  variance  eat  last*  of  {(t)  baaed  on  the 
data  (Bi  - H, J,lj )  la  obtalnad  by  applying  Equations  (2,32),  (2.11)  and  (2.12)  (or  Equations  (3.32),  (2.29)  and 
(2.30)  If  the  plant  and  meaaurenant  noiaes  are  correlated).  There  are  no  differentiations  of  ssaaursment  data 
required  in.  this  approach  and  the  order  of  the  filter  has  bssn  rtduosd  from  (n  +  p)  to  n  .  Of  oourss,  this 
solution  requires  that  there  exist  some  measurements  containing  whlte-nola*.  If  the  vector  t,  In  Equation  (2. 88) 
does  not  axlat,  additional  manipulations  must  be  introduced,  as  now  dlaouaaod, 

Suppose  that  ths  plant  la  daaoribed  by  Equation  (2. 57)  but  that  tha  asaaurtmnt*  are  entirely  nolee-free 
(1, at.  there  Is  no  white-note*  In  the  date)  and  described  by 

S,  *  H,(t){  ,  (2.71) 

where  tha  subscript  t  has  been  retained  to  be  consistent  with  Equation  <2. 58).  To  obtain  a  form  that  oan  ba 
treated  by  the  above  procedure,  dlffsientiat*  {,  to  obtain 

8,  a  H,i  +  A,i 

»  (ll,P+  H,)g  +  H,s  .  (3.72) 

To  simplify  tha  dlsouailon,  It  shall  be  assumed  that  the  oovarlanoe  H,W*  of  the  noise  H,g  le  poeltive- 
deflnit*.  The  differentiated  data  j,  oan  now  be  treated  as  additional  measursmont  data,  so  that  ths  complete 
system  has  the  fora 
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i  =  m>j  +  s 

ll  £  i,  =  +  l‘l,(t)]£  +  H,(t)* 

5,  -  , 

and  now  tho  preceding  results  own  be  applied  without  additional  modification. 

From  Equation  (3.88),  the  Maaurement  data  used  In  the  filter  will  bo 

E  =  e,  -  (HjF  +  fijljjS,  .  (3.73) 


where  J,  la  daflned  in  Equation  (2.61).  By  Equation  (3.87),  the  q  is  repreaontad  In  torm*  of  £  ae 

£  ~  [lljF  +  lljlj,^  +  HjW  .  (3.74) 

The  filter  etato  J  Is  still  described  by  Equutlon  (2.65).  Tho  plant  and  measurement  noises  are  correlated 
with  aovurlnnee  matrix 

0(t)S(t-r)  4  EtH1Ct)®(t)wf (T)Hj.:r)] 

C(t)S(t-r)  r  H,(t)Hj(t)S(t  -T)  ,  (2.75) 

The  Initial  conditions  are  still  described  by  Equations  (2. SB)  and  (3.60)  and  Equations  (2.33),  (2.3S)  and  (2.30) 
aust  be  used  for  the  filtering,  Note  alio  that  tho  plant  and  uiiaurimnt  nolas  oovarlanaia  for  thli  eysteu  are 
H,«lJ  and  HjttHj  .  respectively, 

From  Equation  (3.33),  tho  estlMts  of  £  Is  given  by 

£  *  0J,|  +  0J,£,  t  K[£-JJ,f]  ,  (3.76) 


■hers 

0  6  A,  +  R,r 

J  £  rt,  +  R,F 


The  |  ilvsn  by  Equation  (3.74)  appears  to  Indicate  that  s  differentiation  fc,  Is  required  In  order  to  obtain 
on  sit  Irate  of  £  .  This  requirement  oen  be  circumvented  computationally  by  resorting  to  the  following  artifice. 
Define 


•»d 


{*  $  i  •-  K(t)Sl  . 

so  that. 


i*  *  I  -  **,  -  **, 

»  0fJ,|  +  (U,5,  +  -  Km,  -  fcj,  . 

Using  Equation  (2.73),  this  reduces  to 

'£*  *  d,J,|  -  +  +  [OJ.-Ub,  (3.77) 

end  dose  not  require  the  differentiation  of  data.  The  gale  matrix  K  suet  be  differentiated,  however. 

There  le  a  special  oul,,',,  that  la  sufficiently  important  that  It  will  be  considered  hern  end  will  oomplete 
the  dleouselon  of  colored  seieurement  noise.  In  the  following  the  notation  will  be  ohenged  somewhat  from  that 
used  elsewhere  In  this  section,  In  order  to  deal  not  with  the  augmented  etate  Implied  by  Equation  (3.57)  but 
with  a  veotor  that  le  more  closely  akin  to  the  etate  of  the  physical  system.  Let  the  system  be  described  by 

i  *  r(t)£  +  f  (3.78) 

I  ■  H(t)j  +  a  ,  (3.79) 

(here  q  It  a  gero  Man  oolored-nolae  prooses  deacribtd  by  a  ehaptng  filter, 

8  '=  A(t)o  +  K  ,  (3.80) 
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and  with  init ini  covariance  E Cn < t0) nT (t„ ) ]  =  N  *h«rc  i  has  a  positive-definite  eovarisnco  matrix.  Assume, 
»)jr,  that  v  and  w  srn  uncorroluted.  This  Is  essentially  the  problem  cons iderod  immediately  shove,  except 
that  2  1*  1,1  n -dimensional  state  unmipmontvd  by  measurement  noise  variables.  To  put  this  system  in  s  form 
compatible  with  Equations  (2.97)  and  (2  71),  rewrite  Equations  (2.78)  -  (2.80)  as 


where 


and 


(2.81) 


(2.82) 


for  this  problem  the  definition  of  the  matrix  H,  required  In  the  trens format  ion  T  of  Equation  (2.80)  can 
be  defined  explicitly  ae 

H,  =  (l  0]  , 

mo  that  transformation  T  is 


and 


•1th  this  transformation,  the  f Uterine  stats  f  le 

£  •  s  . 

eo  that  {  is  to  be  eetlmmted  directly.  Obviously  j  is  described  by  Equation  12.78),  although  it  can  be 
verified  that  Equation  (2.69)  reduces  to  this  equation  by  substituting  appropriately.  The  meaeurement  given  by 
Equation  (2.98)  la  seen  to  be 

j  -  A(t)|  =  (HF-AH  +  H]x  +  Hw  +  v  .  (2.86) 

The  estimate  for  ;  can  be  written  explicitly  in  the  following  manner. 

i  =  P(t)l  +  K(t)[i-A<t)5-J(t)£]  ,  (2.86) 

where  J  =  HF  -  AH  +  ft  . 

The  initial  condition  for  |(t#)  is  obtained  from  Equation  (2.88)  and  is  found  to  be 


i(t„)  =  SKVHf(t,)[H(tt)«l(;()llT(t,)  ^(tjll-'ilt,)  ,  (2.8T) 

where  M(tg)  le  the  covarlence  of  the  Initial  etsto  x (t e )  . 

The  gain  matrix  K(t)  le  given  by 

E(t)  =  [P(t)JT(t)  +Q(t)HT(t)I  [H(t)«(t)HT(t>  +  R(t )]  * 1  (2.88) 

mad  the  error  eovarlmnee  matrii  is 

ft  m  F(t)P  +  PT(t)P  +  <t(t)  -’n(t)[H(t)H(t)HT(t)  +  R(t)]KT(t)  .  (2.89) 

The  1  ;U1  conditions  in  d#ttrmi  *d  from  Equation  (2  89)  to  b« 

P(t„>  =  H(t0)  -  H(t0)«T(t,)[H(t0)M(t,)HT(t0)  tN(t0)]'1H(t0)H(t0)  .  (2.90) 


These  results  reduce  to  those  published  by  Buoy1*  and  by  Stemr  end  Stubberud”  after  minor  changes  In  the  model 
and  notation  arv  Introduced. 


1,3  Linear  Smoothing 


In  this  lection  the  problem  of  flndlni  the  linear,  unbiased,  minimum  variance  estimate  of  j(t)  ,  liven  the 
data  5(r)  ,  r  >  t  ,  la  considered.  The  system  doflncd  by  Equations  (1.1)  -  (1.2)  Is  treated  and  the  innova¬ 
tions  approach  of  Section  2.1,3  la  used  to  derive  the  solution.  The  development  follows  Kailath1’. 

Based  on  the  rosults  of  unction  2.1.2,  suppose  that  the  smoothed  estimate  la  ilven  by 

J(tlr)  =  /TW,(t,s)r(s)  da  ,  (2.81) 

whirs  w#  is  choain  so  that  the  error  in  the  estimate  ie  orthogonal  to  the  innovation#  prooeea  £(s) 

E{[x(t)  -  i(t|r)]Tr(cr)}  r  o,  te  <  O  <  T  . 

from  the  orthogonality  property,  ono  obtaina  the  condition  that 


E[j(t)£T(o)l  =  fTWi|(t,S)Ett(S)£T((7)]  ds 

'*0 

-  W,(t,cr)R(cr)  . 

But  this  lmplleu  that 

i(tlr)  a  rEtxttlr^ulRVdlrd)  d* 

=  f*  E[j(t)£T<s)]R-‘(s)r(s)  ds  +  f  EEidJiVsllR-'fsJrts)  ds  . 
The  first  tern  osn  be  recognized  as  the  filtered  estimate;  so  Equation  (2.03)  rsduoes  to 

i 

gftlr)  *  g(tlt)  +  JtT«£s(t)Et(s)]R'l(s)r(s)  ds  . 

Now  oonaidet  E[j(t)£T(s)]  .  ft  on  Equation  (2.92).  and  assuaisf  that  cr  >  t  , 

W,(t.o-)R(cr)  =  E[»(t)£T(o->3 

=  E[»(t>gVlcr)HT(or)  +i(t)VT(cr)] 

=  *CR(t)gT(o-|o-)]llT(o-) 

W  l{[*(tlt)  +l(tlt)]XT(C7|<7))HT(0-) 

=  P(t,Cr)HT(cr)  ,  cr  >  t  , 

P(t,<r)  £  l[g(tlt)gT(o-|cr)]  , 


•bars 


Uslni  this  dsflnltion,  the  smoothed  satinets  becomes 


|(t|r)  =  J(tlt)  +  fT P(t,*)HT(m)R"l(»)£(s)  ds 
%  * 


(2.92) 


(2.93) 


(2.94) 


(2.95) 


(2. 96) 


This  shows  that  J (t It)  la  the  linear  'oonblnst Ion  of  the  filtered  eatinste  j(tlt)  and  a  correction  term  that 
oontalna  the  data  not  included  In  i(tl|)  . 


The  error  oovarianoe  matrix  P(tlv)  i  E[j(t It) JT(t It)]  can  bt  defined  in  terns  of  the  filtering  error  oovsrl 
anos  aatrlx  P(tit)  .  Observe  that  the  error  in  the  snoothed  estimate  is 


I(tlT)  ^g(tlt)  -  Jrp(t,s)HT(s)R-‘(s)i(s)  d»  . 


Sines  l(tlr)  pi  orthogonal  to  ths  residual  r(s)  ,  It  is  dear  that 

A 


-jj^!g(tlr)gT(t|r)]  =  E[*(tlt)*T(tlt)]  -  J*  P(t,  s)HT(s)R'*  (s)E[£(e)gT(tlt)3  ds 
P(t!r)  =  P(tlt)  -  frp(t,S)HI(s)R'l(s)H(s)P(s,t)  ds  . 


(2.97) 
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The  integrand  1»  non-negatlve-deflnlte,  ao  the  affect  of  tha  additional  data  In  the  imoothed  ultimate  li  to 
raduce  the  arrar  in  the  filtered  estimate. 

The  correlation  matrix  P(t,e)  In  anally  determined.  As  defined,  It  is  known  that 

P(t,s)  $  E[|(tlt)8T(s|e))  ,  a  >  t  . 

But  g(tlt)  1»  the  solution  of 

i  =  [P(tl -K{t)H(t)lX  +  »(t)  -  K(t)j(t)  ; 

to 

*(al»)  =  4'(s,t)J(tlt)  t  f(n,tl  |t* Hl(t,<t)Cw«7)-K((r)y(o)]  da  , 


whero  '!’<»■  t )  Is  the  fundamental  solution  obtained  from  tlio  matrix  differential  equation 

-  Vta.t)  =  [P(»> -K(a)ll(»)]'t'<a,t)  .  ♦ft.  t>  =  I, 

da 

Using  thla  solution,  ona  obtains 


P(t,a)  =  P(tlt)¥T(s,t)  . 


Tha  a moot had  tetlmata  beooass 

J(tlr)  x  <(tltl  +  P(tlt)  J”  tT(B,t)HT(s>R'1(e)r(a)  da 


(2.  SB) 


P(tlT)  £  BCKtlr)f(tlv)] 

a  P(tlt)  -P(tlt)  f*  tT(s,t)HT(s)R'1  (a)  H(s)’}(s,t)  d »  P(tlt) 

6  Pftltl  -  P<tlt)H,(t,T)P(tlt)  ,  (2. 88) 

where 

H,(t,T)  x  J,JV(s.t)HT<s)R'1<a)H(s)'l'<s,t)  da  . 

Tha  matrix  Mg(t,r)  la  alitlar  to  the  obieivsblllty  matrix  introduced  in  Section  3.1.  Equations  (2.98)  and 
(2.98)  are  the  general  smoothing  squat  Iona.  Three  classes  of  amoothlng  problems  have  been  discussed  in  the 
literature*1: 

(t)  Fixed- Interval  smoothing*’:  Tha  Initial  time  t4  and  tha  final  time  r  art  fixed. 

(11)  Plxed-polnt  amoothlng10:  Tha  tlaa  t  for  thlch  a  imoothed  aitimate  is  determined  la  fixed,  while  the 
amount  of  data  increases  (i  s.  r  lnoraassa). 

(Hi)  Plxmd-lag  smoothing":  Tha  t turn  for  which  a  imoothed  estimate  is  determined  is  a  fixad  amount  A  behind 
the  moat  recant  data  occurring  it  tin  v 

Theaa  raaultS  can  bm  derived3 1  from  tha  general  raaulta  and  will  not  bs  dlsonaaad  bars. 


3.  OBSERVABILITY  AND  THE  BEHAVIOR  OP  THE  ERROR  COVARIANCE  RATRIX 

In  this  saotlon  two  important  concepts  related  to  the  linear  estimation  problsm  are  dlscueetd.  The  first  of 
these  le  observability11 i01,  that  ir,  tha  property  of  a  system  which  permits  estimation  of  Its  stata.  The  second 
concept  la  tha  stability  of  tha  estimate  as  defined  by  the  behavior  of  the  error  covariance11’1*. 

3. 1  Observability  of  Deterministic  Systems 

Consider  a  ayatea  described  by  Equations  (1.1)  and  (1.2).  In  contrast  to  section  2.  it  is  assumed  at  this 
point  that  w(t)  la  a  deterministic  signal  and  that  v(t)  is  identically  zero.  A  si  ate  j(t)  of  the  resultant 
daterainlatlo  system  la  oalled  ob strvabli  If  from  tho  Input  w(r)  ,  t#  <  r  <  t  ,  and  the  output  g(t)  ,  x(t) 


can  be  completely  determined.  It  *11  *t*tee  i(t)  correepondlng  to  *11  adnlmible  J(t)  uto  observable,  t ho 
system  1*  called  completely  observable. 

Tb*  lolutlon  of  Equation  (1.1)  i*  given  by 


J(t)  =  <f(t,t0)J(t0)  +  |t‘  $(t,r>g(r)  dr  , 


(3.1) 


where  4>(t,r)  1*  the  tr*n*ltlon  matrix  for  Equation  (1.1), 

d$(t,r) 

— ——  -  FWtU.r)  j  $(r,r)  n  i  .  (3.3) 


The  w(t)  ,  tc  <  r  f  t  .  and  $(t,r)  completely  define  the  aaoond  term  appearing  In  Equation  (3.i).  Apparently 
If  s(t0)  can  be  completely  determined  from  knowledge  of  7,(t)  ,  then  x(t)  can  be  completely  determined,  that 
In,  the  state  x(t)  will  be  observable.  If  this  la  truo  for  uo  arbitrary  Btate,  then  tho  aystom  la  completely 
observable. 

3.1.1  Observability  Criterion 

Combining  Equation  (3.1)  and  Equation  (1.2)  »lth  x(t )  aet  to  giro,  the  obtarvation  vector  g(t)  la  given 
by 

«<t>  *  H(t)g(t)  =  H(t)«(t.r)t(r)  dr  +  H(t)*(t,t,)J(t,)  .  (3.3) 

Knowledge  of  2(t)  and  f(r)  ,  t0  <  r  <  t  ,  completely  determines 

A|(t)  *  aft)  -  ft  ll(t)$(t,r)3(<r)  dr 
*4o 

*  H(t)4(t,t0)4(t0)  j  t0  <r  ft  .  (3.0 

■Thue  It  i*  sufficient  to  deal  with  Aj(r)  ,  t,  <t  <  t  ,  alone  and  seek  to  determine  under  what  conditions 
g(t()  can  be  complataly  datareinad  from  Aj(r)  ,  t0  <  r  <  t  .  The**  condltlona  are  then  conditions  for  the 
observability  of  the  atat*  a(t>  ■  If'  thaae  conditions  do  not  depend  on  i(t0)  or  on  As(r)  ,  t,  <r  <  t  , 
they  are  also  condltlona  for  oomplat*  observability  of  the  system, 

Now  consider  a  linear  function  of  tha  form 


J*  •t(r)As(T)  dr  ,  0.5) 

where  s(r)  la  a  aatrlx  of  piecewise  continuous  functions.  The  eystea  le  completely  observable  If,  for  eoot 
t  >  t0  ,  an  a(r)  exists  auoh  that  thle  funotlcn  equals  x(tg>  for  arbitrary  j(t()  .  since  Ai(r)  la 
linear  In  i(te)  ,  only  linear  functions  naad  be  oonsldered. 

Theorem  3. 1 

A  neceeeary  and  sufficient  condition  that  a  system  defined  by  Equations  (l.l)  and  (1.2),  with  w(t)  a  deter- 
mloletio  function  and  j(t)  identically  tero,  be  completely  obeervable  la  that  the  matrix 

«<t0,t)  =  $T(T,t0)HT(T)H(T)$(r,t|J)  dr  (3.6) 

b«  poaltlve-definlt*  for  soaa,  t  >  t0  . 

Proof  of  Sufficiency 

Assume  that  M(t0,t)  Is  poaltlve-dafinlta  and  thus  ha*  an  lnvtns.  In  Equation  (3.5)  let 

a(r)  =  H(t)$(i  ,  ta)M* 1  (tj ,  t)  i  (3.7) 

than  P  iT(r)Aj(r)  dr  =  P  rl(t,.t)<*T(r,t0)HT(r)  Aj(r)  dr 

#to  **0' 

=  K-‘(t0,t>  f‘,'tI(T,t0>HT(T)H<T)$(rit(|>  dr  J(t„) 

*0 

=  l(t0>  .  (3,5) 


.-.u  > 


VWv.’- 
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(line*  the  condition  Is  independent  of  j(t0)  ,  the  system  le  completely  obeervable. 


Proof  of  Nt ctiiity  (by  Contradiction) 

Buppost  thi  tjfttcn  la  completely  obaervtble,  but  that  M(t0,t)  la  singular  and  honoe  not  poiitivc-dofinito. 
Thia  iaplln  that  a  non-itro  oonstsnt  vaotor  £  exists  such  that 


gTM(t4,t)E  =  gT  J*  <J’V,tt)HtCnH{T)#(f1tn)  dT  g 

=  f*  [H(T)$(T,t4)g]T  [H(T)<I>(r,t0)g]  dr 
•t* 


Since  H(T)$(T,t4)g  la  a  continuous  function  for  tB  <  r  <  t  ,  it  meat  bo  idantioally  zero  in  order  that  Equa¬ 
tion  (3.0)  be  aatlsfled. 

Noe.  If  tho  system  is  completely  observable,  then  for  *(t4)  =  g  thero  oxiata  an  b*(t)  ,  t0  <  r  <  t  ,  auch 
that 


|*  dr  =  J*  »*T(T)H(T)i>(T,t4)g  dr  =  g 


However,  since  H(T)$(r,t0)g  *  0  ,  t0  <  r  <  t  ,  tha  last  equality  cannot  hold  and  the  syitem  la  not  completely 
observable. 

fhen  H(t)  and  F(t)  are  constant  mstrloei,  tha  complete  observability  criterion  can  be  reduced  to  an 
altebralo  or iter  Ion. 

Theorem  3.2 

A  necessary  and  sufficient  condition  that  a  system  defined  by  Equations  (1.1)  and  (1.3),  with  *(t)  a  deter¬ 
ministic  function,  v(t)  Identically  aero,  and  H(t)  and  F(t)  constant  matrices,  bo  completely  observable 
le  that  tba  matrix  (d  lam  ns  Ion  nxmn) 

tl  *  W.W . (FT)n'lHT)  (3.11) 

have  rank  n  (tbe  dimension  of  tha  state  &(t„)). 

Proof  of  Suffieitncy  (by  Oontraliction) 

lines  tha  system  is  ties -Invariant,  t(  may  be  set  equal  to  aero  without  loan  of  isnerallty.  Also 

*(t,0)  v  eM  .  (3.13) 

Ut  bt  ,  h( . h,  be  the  columns  of  HT  .  Assume  that  U  has  rent  n  but  that  tho  eyataa  la  not  oom- 

plately  observable,  that  la,  H(0,t)  la  a  Insular.  If  M(0,t)  la  lingular  than  a  non-zero  g  exists  such  thst 


plstsly  cbservsble,  that  la,  H(0,t)  la  alnsular.  If  M(0,t)  Is  singular  than  s  non-zero  g  exists  such  that 

gV^bj  =0l  0<r<t,  1  =  1,2 .  a.  (3.13) 

Noe  differentiate  each  of  the  a  Equations  (3.13)  J  times,  J  ss  0,1,2 .  n-1  ,  thus  genermtlns 

iWlTthj  «•  0  ;  1  ■  1,2 .  m  and  J  =  0, 1 .  n  - 1  ,  (3.14) 

Noe  Equations  (3.14)  must  hold  tor  all  t  >  0  ,  slnoe  U  Is  oonstsnt.  In  the  Halt  as  t  tpprosohes  zero, 
Equations  (3.14)  become 

g,(rT)Jhl  =  0  ;  1  «  1,3 .  m  and  J  =  0,1 .  n-1  .  (3.15) 

It  tha  rank  of  U  la  n  ,  than  g  =  0  ,  ehleb  contradicts  tha  aaaumptlon  that  g  d  0  , 

Proof  of  Noetui  ty 

Asaume  tha  aymtsm  la  oomplataly  observable  but  that  tha  rank  of  U  la  less  than  n  .  There  then  exists  s 
noo-aaro  g  which  satisfies  Equation  (3, 15).  Noe  fora 


gVTtHi  =  gT  ^  (rTt)J/JI  ^ 

=  gT  Oj(rTt)Jhi  ,  1  =  1,2, 
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•hero  the  last  equality  follows  from  tho  Cuyley-Hsmllton  thoorom.  It  follows  from  Equation  o.  ic)  tlmt 

BTM(0,  t)£  =  0  (3,17) 

for  somt  pfO,  thus  contradicting  the  assumption  thr.t  tho  system  is  completely  observsblo. 

3.1.3  Obitrvabllity  and  leait-Si/uaree  Retinatei 

Consider  sgnln  s  system  described  by  Equetlons  (l.i)  and  0,2).  In  this  ones  it  is  assumed  that  w(t)  is 
identically  zero  and  y(t)  is  a  vector  white-noise  with  covariance  matrix  R(t)S(t-r)  ,  where  R(t)  is  poeitlve- 
deflnite.  Now  tho  observation  veotor  oan  bo  written  in  tho  form 

«(t)  s  H(t)*(t.t0)s(t0)  +  x(t)  .  (3,18) 

This  system  in  oalled  completely  obiervable  if,  for  every  t„  and  every  J(t0)  ,  there  exists  a  t  >  0  such 
that,  an  unbiased  estimate  J(t0)  ,  which  is  s  linear  function  of  g(t)  ,  oan  be  constructed.  The  joneral 
criterion  for  complete  obeorvahllity  is  ilvou  in  the  following  theorem. 

Theorem  3.  3 

A  neoeseary  and  auffiolant  oondltion  that  a  ayetem  deflnod  by  Equation!  (1.1)  and  (1.2),  with  w(t)  identically 
taro  and  x(t)  a  white-nolee  with  autocorrelation  matrix  R(t)5(t-r)  ,  R(t)  positive-definite,  be  completely 
observable  ia  that  the  matrix 
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be  poaitiveideflnite  for  some  t  >  t„  . 

The  proof  of  this  theorem  parallels  that  of  Theorem  3,1. 

If  tha  system  ia  tlmo- invar  lent,  that  la,  l((t)  and  F(t)  arc  oonstant,  then  the  ooopleta  observability 
erltirlon  of  Thaoram  3.3  oan  be  simplified  to  the  sliebrulo  criterion  of  the  following  theorem. 

Theorem  3.4 

A  neoeaeary  and  sufficient  condition  that  tha  system  defined  in  Theorem  3.3  be  completely  observable  la  that 
the  matrix 

U  *  [HT.rTHT . (Ft)»-‘Ht]  (3.30) 

have  rank  n  (the  dimension  of  the  state  g(t)). 

The  proof  of  this  theorem  pi-rallels  that,  of  Theorem  3.3  and  is  not  fiven, 

3.3  The  Hatrlx-Ricattl  Equation 
3-3.1  General  Solution 

In  Section  3  it  wan  ehown  that  u  matrix  differential  aquation  of  the  Rloatti  type  la  of  central  importance 
in  the  linear  estimation  problem.  In  tlila  asotlon  the  analytic  aolutlon  of  thla  type  of  equation  ia  dlioussed1'. 

Consider  tha  (antral  matrlx-Rldatti  equation  of  the  fori 


#(t)  =  W(t)  AT(t)  +  A(t)»(t>  +  I(t)B(t)*(t)  +  C(t)  , 


with  the  initial  oondltion 


where  (,  la  a  non-neiatlve-dwfinlta  matrix. 

Tha  mstrioeu  A ( t j  ,  Bit)  ,  and  C(t)  are  nsn  matrioea  of  oontlnuoua  functions.  Further,  B(t)  and 
C(t)  are  assumed  to  l-e  non-nexat lve-definitw  for  all  t  )  t,  Now  consider  the  pair  of  linear  matrix  differ¬ 
ential  equation) 

t(t)  =  A(t)Y(t)  +  C(t)Z(t)  ;  T(t-)  =  W0 
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4(t)  =  -B(t)Y(t)  -  AT(t)Z(t)  ;  Z(t„)  =  I. 


H  4  *  4  .  *  4  s  '  .  . 

.*  J 


It  cm  be  shown  by  direct  substitution  that 


Y(t)  =  f(t)Z(t)  .  . 


Di  .ferentlating  thin  forie 


IM1H(  Equation  (3.32).  this  becoaoa 


t(t)  =  *<t)Z(t)  f  t(t)4<t)  . 


A(t)Y(t)  +  C(t,)Z(t)  =  *(t)Z(t)  -  *(t)  B(t) Y(t )  -  W(t)AT(t)  Z(t)  . 
Bubatltutlm  Y(t)  =  W(t.)Z(t)  and  collecting  tarsus  produces  tho  equation 

[*(t) -W(t)AT(t)  -  A(t)V*<t) -W(t)B(t)*(t) -C(t)]Z(t)  »  0. 

Now  If  Z(t)  la  nohslngular  for  all  t  >  t.  ,  thla  aquation  la  equivalent  to  Equation  (3.21),  and 


Not*  alto  that 


*(t)  =  Y(t)Z*‘(t)  . 


*(t0)  a  Y(tj)  Z* 1  (t0)  e  W„Y  a  *s  ; 


thua  tha  Initial  condition  la  alao  sntlafled. 

To  ahow  that  Z(t)  la  nonalngular,  it  la  noted  that 

i(t)  a  -B(t)*Y(l)  -  A’(t)Z(t) 

«  C-A*(t)  -B(t)  *(t)]Z(t)  .  (3. 2D) 

Since  Z(t0)  x  l  ,  thon  Z(t)  la  a  tranaltlon  natrlx  and  heces  nonalngular. 

It  waa  eeen  In  Baotlon  3  that  there  are  two  forms  of  the  error  covarlenoc  equation.  The  first- of  these  la 
fr(tlt)  =  P(tlt)[r(t)«K(t)H(t)]T  +  [r(t)-r(t)K(t)]p(tlt)  +  K(t)B(t)Kt(t>  +  q(t)  o.so) 
Kt»>  *  P„  . 

Comparing  Equation  (3.30)  with  Equation  (3.31)  the  following  equivalent  get  of  equation!  la  obtained  by  a  com- 
parlaon  with  Equatlona  (3.32); 

*(t)  »  [P(t)-K(t)H(t)]Y(t)  +  [K(t) R(t) KT(t)  +  Q(t)]Z(t)  j  Y(t„)  r.  P, 

(3.31) 

4(t)  *  ~[p<t) -g(t>H(t)]TZ(t>  ;  Z(t„)  a  I. 

How  Z(t)  a  ^(tj.t)  ,  (3.32) 

where  V(t.t,)  la  a  transition  oatrlx  describing  the  filter  dynasties  and  eatlefylng 


'  ri¥(t,t.) 


Cr(t)-r.(t)H(t)]?(t,t.) 


=  I  . 


Y(t)  can  now  be  written  a* 


Y(t)  a  *(t,t,)P5  +  fS(t,r)  E(T)R(r)KT(r)+Q(r)  'Tlt^r)  dr 

"f. 


final 1*. 


f(tlt)  *  Y(t)Z’1 (t) 


^{t.t0)  [p0  +  fS(t0,T)HK(T)B(r)KT(T)+(l(T)]?1f(t1T)  dT]<tT(t.t0 
•a 


a  *  •  ^  " 


The  second  form  of  the  error  oovarlnncu  equation  It  obtained  from  Equation  (8.30)  by  lotting 


K(t)  »  P(tlt)tlT(t>r‘(t)  . 

The  result In*  equation  In 

f(tlt)  =  P (t I t)FT(t)  +  F(t)P(tlt)  -  P(t|t)HT(t)H-'(t)H(t)P(tlt)  +  Q(t > 


«(t.t.) 


The  aet  of  equivalent  linear  equatlona  ia 

t(t)  =  F(t)Y(t)  +  Qft)Z(t);  Y(t0)  =  P„ 

4(t)  =  HT(t)RM(t)H(t)  Y(t)  -  rT(t)P,<t)  :  Z(t0)  =  I. 

Now  lot 

eii<t.t0>  S„(t.t0)' 

.  «« <*•*»>  ©glft.t0)  _ 

be  the  traneltlon  matrix  oorreepondln*  to  the  aatrix 

F(t)  Q(t ) 

_•  HT(t)  irl(t)ii<t)  -FT(t) 

Therefore 

Y(t)  =  9u<t.t0)P0  +  ©lf  ft,t0) 

Z<t)  »  ®,,(t.t0)P0  +  0„(t,t#) 

.and  ilnaUjr 

P(tlt)  a  Y(t) Z" 1  (t) 

«  C9.r  tetl(t,t0)P.  +  0„(t,t,,)]‘‘  . 

We  non  oonalder  t*o  special  uaaea. 

Cite  il  Let  H  ■  0  ,  ao  that 

<■  »  rr'(t)  +  r<t>p  +  «(t)  . 


In  thla  oaee  the  Itloattl  Equation  (3. 37)  reducet  to  a  linear  aatrix  aquation  whoee  aolutlon  can  be 
ualnc  the  central  forma  lien.  Prom  Equation  (3.38), 

4  *  -PT(t)Z  ,  Z(t„>  =  I  , 

But  thla  equation  it  the  adjoint  of 

i  »  P(t)«  ,  t(t,,t8>  a  I 

ao 

Z(t)  =  «,* <t,t0>Z(t0)  =  *T(t5,t)  . 


Thla  lapllea  that. 

«tl(t,t0)  ■  0 
9,,<t,t,)  x  (t „ , t )  . 

Uiln*  Equation  (3.45),  on*  hat 


t  =  P(t)Y  +  S(t)$T(t0,t)  , 


(3.3e: 

(3.37! 

(3.3B: 

(3.39: 

(3.40: 

(3.41] 

(3.43) 

(3.43) 

(3.44) 
obtained 


(3.45) 


•o  it  followa  that 


V(t)  *  +  *(t,t0)  ft4'rt#,T)«T)tT(t01T)  dr 

•tfl 


(3. tfl) 


which  Instill*)  th*t 


fiu(t,tc)  = 


813(t,t0)  =  «<t.t0)  r  *(t0.r)Qfr)+T(t#,T)  dr  . 

*kn 

Bub)tltuting  then*  Into  Equation  (3.43).  the  aolutlon  of  the  linear  matrix  different U1  equation  la  fountl  to  bo 

(3.41) 


P(t|t)  =  #(t.tt)P(t#>*T(t.t#)  +  4>(t.t„) 


/t<>(t().T)Q(r)<JT(t|)1r)  dr 

t  ft 


*T(t,t#) 


Can  2:  Let  Q  »  0  ,  ao  tnat 

f  =  PPT(t)  i  P(t)P  -  PHT(W‘(t)H(t)P  . 
In  thia  oata  th*  variance  aquation  haa  no  forcing  tarn  and  une  oan  consider 

t  =  P(t)Y  . 

Thle  baa  th*  aolutlon 

Y(t)  w(  $<t,t0)P(t0) 

and  Infill**  that 

«„<t.t0)  «  *<t,tc) 

*U  <*.»«>  ■  0. 

Ualng  Equation  (3,49),  th*  aquation  for  i  bacon** 

t  *  -PT<t)Z  +  H^tlR'^tJHdl^t.t^P,  , 

Thla  haa  th*  aolutlon 

ft , 


(3.48) 


(3.49) 


Z(t)  =  #T<tc.t)  +  *T(t0.t>  f V<T.t0)HT(r>rl<T>H<T)<fyr,t(>  dr  P„ 

*44 


(3.80) 


•o  that 


^(t.t,)  «  4T (t„, t )  f *  #T (t, t„) HT(r) R’1  H(r) $(r , t,)  dr 
Jto 

9„<t,t0)  «■  ♦T(t0,t)  . 

Th*  solution  of  Equation  <3.48),  urine  Equations  (3.40)  and  (3.50)  In  Equstion  (3.43),  Is  sssn  to  bo 


*  ft  ”  “ t 

P(t|t)  *  ♦(t.t,)?,  «T(t,,t)  +#T(tglt)J  $,(r1t0)HT(T)R'1(i)H(T)®(r,t#)  dr  Pa 
L  **e 


P0|l  +  J*  *T(T1t1!)Hlr(T)R-,(r)H(r)«(T,t())  dr  P,j  *T(t,ta)  . 


(3.81) 


hut  obetrv*  that  tba  Integral  t*rm  la  Identically  aqual  to  th*  oburvablllty  matrix  M(t0,t)  defined  In  Equation 
(1.19).  Tbl*  auggtst*  th*  laportant  rola  played  by  obaarvablUty  conald»ration*  in  utabliihlng  th*  behavior  of 
th*  arror  of  th*  alnlaua  variance  «itluator 


3.2.  2  Solution  far  thi  Stationary  Cat* 


Buppoa*  In  Equation  (3.17)  that  tbi  ooofflnlant  aatrlcia  t  ,  H  ,  R  ,  and  q  are  oonatant. .  In  this  caa*. 
on*  oan  obtaiu  aor*  lnelght  Into  th*  character  of  th*  general  aolutlon  and  oan  define  th*  ateady-atnte  aolutlon. 
Pore 

~t  Q 


N  d 


HtR'‘H  -PT 


(3.83) 


where  N  represent*  the  mntr lx  of  coefficients  implied  In  tho  system  (3.38).  It  has  been  shown"  that  the 
eigenvalue*  of  N  ere  real  and  that  they  are  symaolrlu  relative  to  the  oriiin.  For  thia  dHouaaton  anppoao 
that  th«  eigenvalue*  aro  distinct  and  let  A  be  tho  nxn  diagonal  matrix  containing  the  eigenvalue*  thnt  are 
positive.  Then,  there  exists  a  tran* format  Ion  T  xuoh  that 


It  can  bo  ehown  that 


Define  natrlcea  fi  and  T.  such  that 


Tii  Tii  n 

,T.i  Ta.  J 


From  Eauatlon  (3.83),  it  follows  that 


T.i  T,» 


Since  this  is  a  linear,  aonstant  ooefflolent  ayetea,  the  solution  of  Eauatlon  (3.38)  is 


0  ( 

--At  5 

J  L* 


ao  thit  Z  tnd  Y  iri 


The  transition  aatrlx  6(t)  for  this  system  la 


8(t)  *  T 


Tg.^Tj,  -  Ti,«'AtTll 


Substitution  of  Eauatlon  (3.89)  into  Eauatlon  (3.13)  yields  the  lolulion  P(t)  . 

P(tlt)  a  [Tie»'AtTli  -»il«At*Tg  +(TueMTjJ-T1,e-AtTjl)P|1]*  a 
*  [T1Je'AtTl.-Tlle«T|1e(Tll^T|1-T„e-AtTj,)P0l-1 


Consider  th«  eteedy-etcte  value  of  P  is  t  -  co  .  Tha  terms  involving  *'At  will  vanish  no 
11m  P(tlt)  0  P_ 


*  t-Tu««T»,  +TIl.A‘TjlP0]  t-T|ytTj,  +  T, ,  «AItJ,P„1  * 1 
«  TurU  t-tf,  +Tj,P0]t-T{,  +T?|P91“»-AtT;il 


■  •  'MnV 


Equation  (3. CO)  Has  a  computational  disadvantage,  sines  only  the  term  e^  appeal!  as  t  Increases  without 
bound,  tt  1*  difficult  to  retain  accuracy  as  t  bsootnss  large  because  of  tho  pronsnos  of  In  both  Y(t) 
and  Z‘l(t)  .  This  problem  can  he  circumvented  by  expressing  the  initial  value  problem  (E)qu  (3.3B))  as  a  two- 
point  boundary-value  problem1*,  Equation  (3,37)  can  ba  rewritten  as 


it  has  been  ihown  that 


Y(t>  *  P(tlt)Z(t) 


Y(0)  a  P(0)Z(0)  . 


Using  Equation  (3.53),  It  oan  ba  aaen  that 


Thtae  ralatlona  imply  that 


Y<0)  «  P(6)  [T„fi(0)  +  Tlf£(Q)] 

Y<0)  *  Tun<0)  +  TlfX(0)  , 

0  *  [Tu -P(0)Tn]n(0)  +  [T„ -P<0)T„]X(0)  , 
t(0)  m  -[Ti,-P<0)TM]-1[Tll-P,T,l]n(0>  $  Rn<0) 


Using  this,  net)  and  £(t)  oan  be  related  by 


X(t)  ■  e'At£<0)  «  #"A*  Rfl(O)  *  »’A*  R#'Atn(t)  ,  (3. 53) 

Thus,  one  finds  that 

Y(t)  =  T„n(t)  +  TwI(t)  «  [Tu +T„a-AtE»-At]n(t) 

Z(t)  *  [T„  +T„e  AtR*-At]  n<t) 

aud  P(tlt)  *  [Tu +T„a‘At«»*At][T„ +I„e’At»e*At]M  ,  (3.63) 

In  tbla  font  only  nagatlva  exponentials  appear  and  the  ataady-atate  value  Pa  expreeeed  by  Equation  (3.61) 
follows  Immediately.  Thus  Equation  (3.53)  appears  to  have  computational  advantage*. 

3.3  lounda  for  the  Error  Ccvmrtanca  Matrix 

The  error  oovarlena*  matrix  P(t)  of  the  Kalman-lucy  filter  provide*  the  primary  statist  leal  meaaura  of 
tha  behavior  of  the  aatlmats.  ■  Slnoa  the  P(tjt)  does  not  depend  upon  meaeurement  data,  it  can  be  examined  to 
determine  the  theoretical  effectiveness  of  a  particular  measurement  prooeee  for  a  given  dynamioel  system.  In 
tble  emotion  upper  and  lowsr  hounds  for  the  err'  oovsr lanes  matrix  are  derived10' 3 *  that  point  out  tha  Intrin¬ 
sically  different  rolae  played  by  the  plant  aim  moaiurement  noiao  proceeiaa.  The  bound*  indloete  the  Importance 
of  the  determlnlatlo  obaervablUty  con* Ideration*  of  Section  3.1  and  ere  derived  using  earn*  of  the  properties 
of  the  eetrlx-Ricettl  equation  aolutlon  dlsoueesd  in  Section  3.3. 

3.3.1  iSoa*  General  Bounds 

Consider  the  eyetam  defined  by  Equation!  (1.1)  and  (1.3).  This  eyitsm  can  be  reinterpreted  aa  tbs  sum  of 
two  simpler  ayatami,  which  allows  the  effects  of  tha  measurement  and  plant  processes  to  be  examined  separately 
and  thereby  obtain  lnelght  Into  their  influenoe. 


*  '*'  . *  ,11'*  »"  J>  '*,# 

ill 


LsilM  11  1  ■  N  il 

/.y« V-VwV1 

I  I  .**"•**?•  .  *  *  Ji . * 

LY.--yvV.vii 


teal* 

,\VV\-\w\AV* 

•  ■  ^  .*•  /fc  V  *s 

*.*  %"  *  *  *  S  *  S  i". 


*.  »■  •  '  w  '  O  '  \ 

1  W  ■  ’  »  '  m  1*  »  1  1 

•  ,  W\V.  J 

1  *•>  ■  •  ,  -  %  ■  V 

■vv/ iv.svo 


L’-*.  L"VL*L  L rJ'.  >  V  \sT«  1  M-_  l  m  1  »  • 


'.'>.V 

v:<- 


,  '  'V  •  ■  V*  - 
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Dafln*  Syatas  P  aa  a  nyatoa  with  plant  nola*  but  no  noMiurannt  nolaa, 


ip  *  r<t)a"  +  »  .  Ip<‘o>  ■  o  (3.94) 

*p  =  H(t)jp  ,  <3. 6M 

ind  duflna  Syatas  M  to  havu  maiiurawnt  nolaa  but  no  plant  noiia 

i"  -  P(t)»"  ,  **<t„)  =  *<t0>  (3.69) 

|*  =  H (t)g*  1  J  .  (3.67) 


Note  that  J(t0)  =  i*(t0)  +  Sp(te) 

and  that  ip  +  ?  -  ~  Up  ♦  XB3 

at 

=  P(t)  t*P  4  *"]  +  «  , 

to  that  jp(t)  +  x*(t)  '  -  i(t)  .  (3.68) 

Alio,  It  follow*  that 

gft)  ■  +  8*  .  (3.89) 

Th*  minimum  yarlano*  aatiaata  of  j(t)  ,  (Ivan  J(t)  ,  ha*  bam  ahown  to  b* 

i  •  r(t)|  +  K(t)[i-H(t)|]  ,  (3.70) 

whara  tha  optimal  gain  K(t)  la  daflnad  by  Hquatlona  (3.11)  and  (2.13).  Conaldarlni  Syatama  P  and  M,  deflna 
llnaar  aatlaataa  of  jp  and  1*  ,  ualni  tha  optimal  tain  K(t)  of  Equation  (3.70),  aa 

f  *  Pttir  +  *<t).(»'1-H(t)r]  (3,71) 

-  r(t)XH  +  K(t)£|*-H(t>|*‘]  .  (3.72) 

Not*  that  f  and  ar*  not  th*  minimus  varlano*  aatiaatora  for  jp  and  |*  .  Howavar,  it  followa  without 
dlffioulty  that  th*  minimum  rarlano*  aatimat*  of  l  la  «lr*a  by 

J  ■  f*  +  f  ■  (3-73) 

Irit*  tha  arror  In  tha  aatimat*  a* 

I  -  l-J 

.  (*»+»•)-  (r+n 

*  (*p  -r>  +  (»"-n  .  (3  ft) 

llalna  Equation  (3.74),  th*  arror  oovarlano*  satrlx'  P(tlt)  can  b*  aipraaaad  u 
P(tlt)  d  E(Cl(t) -i(tit)][j(t)-|<tlt)]T} 

•  «£<*»- +  B((»p-r)(»‘-»V] 

+  Ef^-rx^-r)’]  **(<»■ -r>c*,-s“>ti  • 

But  »(<*p -r'x*" *o, 

alno*  ip(t,)  <•  0  and  g(t>  and  j(t)  ar*  unonrralatad  whlta-nola*  prouaiaan  *o 

P(tlt)  »  EtdO-rHjP-D7]  +E(tf-n(*!,-nT]  ■  (3.73) 

It  la  poaaibl*  to  atata  aanaral  bounds  for  P(tlt>  .  Buppoai  that  P*(tlt)  and  Pp(tlt)  rapreaent  tha 
minimum  varlano*  arror  oovarlanaa  aitricci  for  Byatama  M  and  P,  raspactlvaly.  Than,  alno*  1’  and  are 
not  th*  minimum  varlanoa  aatimat**  for  thaaa  ayatams,  It  suit  oartalnly  follow  from  Equation  (3.79)  that 


p'tlt)  >  I* (tit)  +  p" (tit)  , 


(3.78) 


where  th*  matrix  notation  A  >  8  lmpliee  thnt  tha  aiutrix  A-B  la  noii-nonatlve-definite 

On  th*  other  hand,  euppoae  that  aomo  gain  other  than  K(t)  la  u*«d  to  obtain  estimates  of  both  jp(t)  and 
l*(t)  .  That  la,  a  auboptlmal  lain  K,(t)  la  used  In  both  aubeyeteiM.  Than,  from  the  definition  of  K(t)  It 
auat  be  true  that 

P(tlt)  <  P*,*(t|t)  +  r»*(tlt)  ,  (3.77) 

there  pba  and  P**  represent  the  error  covarlanoe  matrices  aaaooiated  with  tho  auboptimnl  tain  K*  (t)  . 


3.3.2  Unforced  Dynamical  Plant  with  Noisy  Measurement  Data 
Conalder  tho  ayatea  donorlbod  by 

*  =  m>J  ,  *(t0)  -  *„  (3.7B) 

1!  *  H(t)J  +  x  ,  (3. 78) 

Thla  ayatea  la  ldentloal  with  Byatom  M  but  th*  superscript*  have  been  eliminated  to  simplify  tho  notation,  The 

■lnlnuu  variance  eatlaata  of  &(t)  ,  (Ivan  z(t)  ,  ban  baen  ahotn  to  be  given  by 

i  -  P(t)i  +  K(t)[B-H(t)|]  ,  (3.80) 

there  K(t)  =  P(t I fc)H*(t ) R- * (t)  (3,81) 

•  % 

and  t  *  P(t)P  +  PPT(t)  -  PHT(t)rl(t)H(t)P  .  (3.83) 

But  In  Beatlon  3.3,  It  taa  ehown  (l.e.  Equation  (3. SI))  that  the  ablution  of  the  matrlx-Rloattl  equation  ih 

thla  oaae  la 

P(t|t)  a  *(tIt0)[p-1+M(tc,t)3‘1$T(t,b0)  ,  (3.83) 

there  M(t0,t)  la  tha  observability  matrix  (aee  Equation  (3.18))  and  la  defined  to  be 

M(t0, t)  a  ft#T(T,t(J)Ht(r)R-,(T)H(r)4(T,t0)  dr  (3,84) 


and  4(t,tc)  la  th*  tranaltlon  matrix  aaaooiated  with  th*  dynamical  ayatam  (Eqn  (3.78)). 

Prom  Equation  (3.83),  on*  aeaa  that  th*  behavlur  of  th*  obiarvablllty  matrix  essentially  determlnt*  th* 
behavior  of  P<t It)  .  one  oan  ahow  under  appropriate  oondlt ion*  that  M(tg,t)  la  utrlotly  increasing  with  t 
(1.*,  Il(t(,tf) -M(t0,tt)  1*  po*ltlv*-d*finlt*  for  aoa*  t,  >  t,). 

It  la  altar  from  th*  definition  that 

SH(tL>tt)  &  M(t0,t,)  -  M(t0 ,t,)  *  rt'*T(T,t0)HT(r)R-‘(r)H(T)$(r,t0)  dr 

M 

ao  that  SM(trt|)>0. 

To  oonalder  tha  aaymptotlo  behavior  of  M(t0,t)  ,  and  therefore  P(tlt)  ,  It  la  convenient  to  Introduce  tha 
aoooept  of  q-observabillty, 

Definition:  A  system  1*  aald  to  be  q-observabte  tor  q  >  0  on  an  interval  (t#,tM),  whore  t„  may  be  Infinite, 
It  and  only  If  SM(tj , tk )  la  positive-definite  for  every  tj  ,  tk  euoh  that  tN  >  tk  >  tj  !»  t„  and 

t„  -  tj  >  q  . 

q-obsarvablllty  la  a  alliht  generalization  of  oomplot*  obaarvabllity  and  la  Introduced  to  lneure  that  the 
observability  matrix  M(t„,t)  la  atrlotly  inoreaalni  over  intervals  of  duration  q  .  For  atationary  aystama 
thar*  la  no  difftrtnoe,  no  that  thla  ooneapt  1*  useful  only  for  time-varying  ayetems.  In  thla  oaa*,  q-ohserva- 
blllty  Insures  that  the  syatem  la  oompletaly  obeervabla  for  every  Interval  of  duration  q  . 

It  a  ayatam  la  q-ohaervabla,  then 


M(t.,t)  >  M(t-.t-q)  . 


t  -  q  >  t.  . 
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Lit  tli«  eigenvaluce  N(t0.t)  and  M(t(,t-q)  bo  (X*  >  X‘  >  X‘)  and  (\‘"<1  >  X$‘«  ?  ...  >  Xj-b),  reapootlvoly. 

It  follow*  that 

X*  >  XV  l  X‘  >  Xj-o . \»  >  t‘-b  . 

Thu»,  M(t j,  t)  U  etrictly  Increasing  tn  the  senso  that  all  eiienvHluu*  «ro  strictly  increnNing  uo  t  -  m  , 
although  sobs  mny  remain  constnnt  for  Intervals  of  length  lens  then  q  . 

Tor  *  symmetric  matrix,  tho  largest  eigenvalue  serves  ne  s  matrix  norm  (l.s.  the  apootral  norm),  so  one  can 
•rite 

|lM<t0,t)ll  a  X*  , 

•o  that  one  sees  that 

11m  llM(t,c.t)ll  =  oi  (3.8B) 

t-«> 

and  11m  #M*l(t0.t)ll  ’=  “""IT  *  0  ■  (3'80) 


Noti  that  N‘‘(t„,t)  exists  if  tho  system  Is  dompletely  ohserva’ile  for  t  .  But  Equation  (3,00)  Implies 
that  M' 1 (t0, t)  oonvsross  to  the  zero  matrix,  since  Its  norm  vanishes. 

Assuming  q-obssrvablllty,  one  sees  from  Equation  (3,83)  that  the  error  oovarlanos  matrix  P(tlt)  is  livon 
approximately  by 

P(t|t)  Of  *(t,t0)M-'<t0,t)*-T(t,t0) 

for  t  sufficiently  large.  Slnoe  P‘l  Is  positive-definite,  it  follows  that 

llP<tlt')ll  =  lU’tt.tjlfPJ1  +«(t0,t)]-‘$T(t,t|))ll 

<  u*tt. t0)il'  li[p;,+«<t„,t)]-lii 

<  l!*(t, t0)ll*  lir*<t,,t)ll  ,  (B-Bf) 

As  a  result  of  Equation  <3.07),  one  concludes  the  following! 

7hs  error  covarinnee  aatri*  P(t)  for  (he  (j-obeervable  system  (Eqns  (3.  78)  -  (3.  79))  vanish**  as  t  -  ®  if 
lllTl(t1t(|)ll  converges  to  sero  /alter  than  114ft, t„) II *  increases  If  the  plant  (Eqn  (3.7B))  Is  stable,  then 
this  Is  oertaliily  true. 

This  oonoluslon  Indicates,  for  a  large  class  of  systems,  that  the  effect  of  measurement  nolss  Is  eliminated 
by  filtering  over  a  sufficiently  large  period  of  time.  Reference  to  Equation  (3.81)  also  indicates  that  the 
gain  matytx  K(t)  vanishes  as  the  error  covariance  matrix  tends  to  xero.  As  a  result,  the  estimate  £  tends 
to  be  characterized  by  a  homogeneous,  linear  differential  equation  identical  to  the  plant  equation  (Rqn  (3. 73)). 
This  shows  that  the  most  recent  measurement  data  liave  a  decreasing  influenoe  on  the  estimate.  While  this  behavior 
Is  understandable  from  an  entirely  theoretical  viewpoint  It  should  be  observed  that,  unless  Equstlons  (3.7B)  and 
(3.7#)  aqtually  oonatituta  an  sxaot  model  of  the  eystem,  the  convergence  of  the  P(tlt)  osn  lesd  to  unduly 
optimistic  measure,  of  the  error  In  the  estimate  and  can  ultimately  lesd  to  filter  "divergence"  end  noneensloal 
reitHe34'”. 

3.3.3  /Voiey  Dynamical  Plant  and  (Voiee-free  Measurement  Data 
Consider  a  eystem  containing  no  measurement  noise 

2  ~  P(t)2  +  I  ■  KV  ■  0  {3,88) 

I  =  H ( t ) j  .  0'B»> 

It  ehould  first  be  noted  that  Equations  (3. 88)  end  (3.88)  ere  essentially  Identical  with  the  system  (Equations 
(#, go)  and  (3,33))  treated  In  Hootion  2.2  2.  This  uses  was  discussed  there,  elnc#  the  Kalmsn-Bucy  equstlons 
atn  not  bs  applied  dlrsotly  to  this  system.  Initsad,  the  filter  Is  reduoed  to  dimension  (n-m)  end  Is  based  on 
tbs  system  dmsorlbsd  by  Equation*  (2.89).  (2.58),  and  (2,38).  Certainly,  It  Is  still  possible  to  discuss  tho 
error  covariance  Mtrlx  P(tlt)  asoaclated  with  the  error  In  the  ultimate  of  s(t>  but,  as  a  consequence  of 
the  consideration!  nt  diction  2.2.2,  the  P(tlt)  can  have,  at  most,  rank  n-m  . 

The  n  x  n  error  oovarlanos  matrix  P(tlt)  osn  never  vanish  identically  ss  long  as  the  plant  oovarisnoe 
matrix  9(t)  la  non-zero.  This  la  an  lnmodlate  consequence  of  the  dlsoumlon  In  Beotlon  3.2.1  relating  to 
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Equation  (3,30)  In  Equation  13.(10)  the  mutrlx  K(t)  la  arhitrnry  end  the  associated  solution  in  nlvon  by 

Equation  (3.35).  the  wamireiront  nniso  eovuriiinco  mutrlx  R(t)  cnn  bn  set  eciunl  to  zero  (l.e.  no  immsurniinrit 
nolae)  In  those  equations.  It  Is  obvloua  that  thu  term 


J*  4l(t0.->>ll(r)'l>T(t0iT)  At 


li  non-no«at lvo  (Infinite  and  r.uvcr  vanishes.  The  H'(t. tQ )  Is  n  transition  matrix,  no  It  in  always  non"lnpiilnr. 
Theraforc  the  matrix  F-(t  It)  described  by  Equation  (3. 33)  with  R(t)  sot  equnl  to  zero  never  vunlshos  rnr 
non-zero  Q(t)  .  limn.  In  contrast  with  the  discussion  of  the  preceding  section,  tho  error  covariance  matrix 
P(tlt)  associated  with  Equations  (3.88)  and  (3RD)  vanlshoa  only  under  very  special  conditions,  and  la  never 
poaltlve-def Inlte.  Also  It  bo  cares  apparont  that  the  plant  noise  covnrlanee  matrix  con  serve  to  prevent  the 
error  covariance  matrix  from  becoming  too  small  In  any  principal  direction 

3.3.6  Error  Bound i 

It  was  demonstrated  In  Soctlon  3.3.1  that  the  error  covariance  matrix  can  bo  hounded  by 

pb(tlt)  +  P"(tlt)  <  P(tlt)  <  Pf>*(tlt>  +  Pm*(tlt)  .  (3.00) 


■-  -.  ••  -d  /-i 


«|Y  • 

r>« 

*  \  »  '.4  •> 

/t  s'  ■»*»  •' ,  ■ 

-*  *"<  n  t»  *  •“ 

,  •'*  **.*' 


«*v  «  '  w“‘  W  '  a*^  - 


But  In  Section  3.3.1  the  P"(t|t)  was  expressed  pore  precisely  by  Equation  (3.83).  If  the  Rain  K“(t)  defined 
by  Equations  (3.81)  and  (3.82)  were  used  in  both  tho  M  and  P  eyitema,  then  Equntlon  (3.83)  can  be  also  used 
in  the  upper  bound  and  Equation  (3.90)  bsoomos 

*(t.t0)[PJl  +M(t0,t)]  ','4'T(t.to)  +  P"(tlt)  <  P»"(tlt)  t 't(t,t0)LP5‘ +M(t0,t)]‘l$T(t,t0)  (3  91) 

The  lower  bound  cen  be  reined  by  eliminating  Pp ( 1 1 1 )  ,  so  that 

P(tlt)  J  <I><t.  tQ)  [P- 1  HH(t0.t)]‘‘*T(t.t0)  .  (3.92) 

It  la  ihown  in  Chapter  S  that  this  bound  Is  essent lolly  the  Cramer -Ran  inequality. 

Couaider  the  error  that  one  has  if  there  were  no  filtering  for  system  P  .  Then 


xf  (t)  =  f 1  i(t,r)w(v)  dr  . 

j 


Aeeualng  that  w  baa  zei  o  nean,  and  aiaumlng  that  no  measurements  are  proceeded,  the  beat  estimate  le 


Then,  it  follows  that 


Pp<1(tlt)E[(S-J)(i-l5)T]  =  Jt'f(t,r)«(T)$T(t,r)  d-r 


But  the  matrix  Integral  hue  been  referred  to  as  a  stochastic  controllability  matrix  by  Kalman13.  Let 


=  J*  t(t,T)Q(T)$T(t/r)  dr  . 
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Note  that  Equation  (3.93)  la  Identical  with  Equation  (3.47)  of  Soctlon  3.2.1.  Using  Equation  (3.93),  the  upper 

bound  beooaes 

P(tlt)  <  *(t,t,)[p;‘  +«(t0,t)]'‘*T{t.tt)  +*<t0,t)  .  (3.93) 

Equations  (3.92)  end  (3.93)  provide  more  specific  upper  end  lower  bounds  for  tho  minimum  veriunoe  error 
covariance  matrix.  Prom  the  discussion  of  Section  3.3.2.  it  can  be  seen  that  the  upper  and  lower  bounds  ere 
defined  by  W(t 9 . t)  and  P®(tlt)  as  t  Increases,  since  the  Pa(tlt)  tends  to  vanish  for  q-obeerveble  systems. 

Kalaen  has  derived  bounds  for  the  error  covariance  matrix  which  bear  some  reeemblanoe  to  those  presented 
above13.  It  wee  shown  that 

P(tlt)  <  $(t,T*)M"1(v*,t)<fr(t.T*)  +  »(T*,t)  ,  (3.96) 

•here  r*  defines  the  time  at  which  the  system  le  completely  observable  and  completely  controllable  (l.e. 

H.'T*,t)  end  »(T*,t)  are  positive-definite) .  Equation  (3.96)  13  very  similar  to  Equation  (3,95).  Kalman’s 
lower  bound  Is 
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(3.87) 

ThU  matrix  will  vanish  for  a  q-obsorvable  and  q-ooutrollable  system  and  so  dues  not  appear  to  contain  as' much 
information  as  Equation  (3.92). 

A  linear  dynamical  system  with  transition  matrix  t(t,tt)  is  said  t,o  bs  uniformly  anymptotically  stsblo  if 
HVft. t0)ll  for  all  t  >  t„  , 

•here  «  ,  0  >  0  .  It  is  possible  to  prove  that,  if  the  system  (Equations  (1.1)  and  (1.2))  is  completely  con¬ 
trollable  and  ci ..iplntoly  observable,  thei.  tho  filter  is  uniformly  asymptot ieally  stable.  That  ic.  tho  norm  of 
the  transition  matrix  obtained  as  the  solution  of  the  matrix  differential  equation 

V(t,t()  =  [F(t) -K(t)H(t)]'t'<t,t0)  ,  'KW  =  I 

satisfies  the  inequality  stated  above.  The  proof  of  this  rosult  is  omitted  and  the  reader  la  directed  to 
Kalman1’. 

3.4  Behavior  of  Error  Covariance  for  Stationary  Systems 

To  obtain  more  Insight  into  the  behavior  of  the  error  covarlanoe  matrix,  it  is  informative  to  oonslder 
stationary  systems.  In  this  case,  the  asymptotic  behavior  of  the  error  covariance  oan  be  established  more 
speclfloally  and  the  upper  bound  oan  be  Investigated  more  thoroughly. 

Consider  the  stetlonery  linear  system 

a  =  Fj  +  ■  (3.08) 

2  =  Hi  +  J  ,  (3.90) 

•here  F  and  H  are  oonstant  matrices.  Assume  also  that  the  plant  and  measurement  noise  covariance  matrloes 


Q  and  K  are  conatant. 

As  has  been  sho»n  above,  tha  minimum  varlano*  error  oovarlanos  matrix 

P  :  FP  +  PPT  -  PHtR-1HP  ♦  Q  ,  P(t„>  s  P„  .  (3. 100) 

Let  P„  b*  tho  steady-state  value  of  Equation  (3.100),  as  discussed  In  Ssctlon  3.2.2.  This  matrix  can  be 

determined  from  Equation  (3.61)  end  le  the  solution  of  the  slgebrmio  equation 

O  a  rp„  +  P„Ft  -  P.hV’HP.  H,  (3.101) 

Use  Pa  to  form  a  suboptlmal  gain  for  filter  application 

K,  =  P.hV1  •  (3.102) 

This  gain  oan  be  shown  to  b«  the  gain  obtained  for  the  "olsiiioal"  Wiener  filter.  The  error  covarlanoe  matrix 
for  this  suboptlmal  gain  la  obtained,  using  Equation  (2.9)  or  Equation  (3.30), 

P,  =  (P-K,H)P,  +  P,(F-K,H)t  +  (KfRxJ  +  Q)  ,  Pf(t0)  =  P(t„).  (3.103) 

This  la  a  linear  matrix  equation  of  the  form  treated  In  Section  3.2.1  with  the  steady-stats  value  P„  .  The 
fact  that  Pw (oo)  =  p„  win  be  confirmed  below. 

Ut  SP(tlt)  §  P(tit)-P„,  (3.104) 

•her#  P(tlt)  la  the  minimum  variance  error  covariance  matrix.  Also,  define 

JP,(tlt)  i  Pf(tlt>  -  P„  ,  (3.105) 

and  let  5P  and  SPf  be  assigned  the  Initial  conditions 

5P(t0)  =  SP,(ta)  =  P0-P«  I  5,  .  '1.106) 


Since  the  system  la  stationary,  the  ioltlal  time  tg  oan  be  assumed  to  be  zero  without  loss  of  generality. 
Further,  resume  that 


• 

This  la  a  natural  assumption  and  atatss  that  the  Initial  uncertainty  is  greater  than  the  steady-stats  error. 
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It  follows  from  EwM lorn  (3.104).  ($.101),  and  (3.100)  that 

#  =  <E-K,I1){P  +  5P(P-K,H)r  -  5PHtR'1II5P  .  (3.107) 

But  th Lb  U  a  imtrlx-Mcitti  equation  with  no  forcing  term,  Thin  wan  shown  In  Section  3.3.1  to  have  the  solution 

SP(tlt)  -  ¥(t, t,j)S0 [l  +  M(t,1,t)50]'l'f|T(t1t0)  ,  (3.108) 

whors  V  Is  the  transition  matrix  ssaoemtod  with  the  linear  system  with  coefficient  matrix  (F  —  KWH) ,  But 
$P(t|t)  vanishes  ns  t  tends  to  Infinity  if  the  system  is  completely  observable,  thereby  confirming  that  P0 
Is  tho  steady-state  solution  of  Equation  (3.100). 

0ns  can  alto  obtain,  from  Equations  (3.10S),  (3.101),  and  (3.103), 

5P,  =  (F-KtH)5P,  +  SP,(F-K,H)t  . 

This  Is  •  homogeneous  linear  matrix  equation  and,  from  Equation  <3. 4'/ ) ,  It  follows  that  5P,  tends  to  vanleh 
If  (F-K,H)  reprosouta  a  stable  system.  This  Is  Indeed  the  case  for  an  obeorvahle  and  controllable  Byetem,  so 
thst  ths  stsady-stsbe  value  cf  P,  Is  established  to  be  P„  ,  Thus,  the  osymptotlo  behsvtor  for  the  suboptlmal 
gain  K,  must  be  vory  similar  to  that  for  tho  minimum  variance  gain. 


it  it  true,  from  Equation  (3.47),  that 


A  $  r  -  K,H  . 


5P,(t It)  «  e«J0i*T*  , 


alnae  the  transition  matrix  9(t,0)  assooiatsd  with 

$(t,0>  =  A*(t,0) 
•  ?(t.0)  =  sAt  . 


■One. also  finds,  ..u*inr  .Equutior,  (3,81),  that 


SP(tlt)  a  iAt[S:1 +M(0,t)]'1  e*Tt 


The  difference  between  Pw(tlt)  end  P(tlt)  can  be  established  using  Equations  (3.110)  end  (3.111).  First, 
nots  thet 

SP(tlt)  =  eAt [l  +  80M(0, t)]_l  S0  e*Tt 

=  eAtCl  +  50«(0,t)]'ls''At5Pf(t|t>  . 

Rearrenilng  terns,  one  has 

P,(tlt)  -  P(tlt)  =  5Pt(tlt)  -  SP(tlt)  =  eAt5„M(0,t)e‘AtSP(tlt) 

and  SP <t  1 1 >  =  oAtll'l(0,t)5jl  e*At[P,(tlt)  -P(t|t)]  , 

Equating  Eauatlona  (3.U1)  and  (3. 113),  It  followg  that 

Pf<t|t)  -P(t|t)  =  eAtS6M(0,t) [SJl  + 11(0, t)]'1  . 

Equation  (3.114)  provide!  a  relation  for  the  difference  between  the  error  covariance  of  the  suboptlmal  filter 
and  the  nlnlmum  variance  flltwr.  An  inequality  la  easily  dtrivsd  from  Equation  (3.114)  that  oan  bs  used  to 
dssorlbe  the  behavior  of  tha  error  cover  lame.  Let  X,  and  denote  the  largest,  and  smallest  eigenvalues 
of  A  .  (Note  that  X(  and  are  negative  since  A  represents  a  stable  system.)  Then  the  spectral  norm 
of  ths  transition  matrix  is 


V 


and  it  fdllown  that 


!IM(0, till  =  ||  ft«AT,HTR'1H«*T  dr || 

*0 

<  Jt||o*T’  l|||ll’R“H||||.*l  dr 

•o 

=  I|htr‘1h||  |Vx‘r  dr 

Jo 

IIhtr-‘hII  (  ,x  t  A 

“  “5xT*(*  -V 

IIhtr"'h!|  /  ix  t\ 

=  a|x,|  0"  )' 

One  also  sees  that 

II  [«;l  +  M(o,t)]*‘||  <  ||sc||  . 

Using  Equations  (3.110)  throuih  (3.118)  in  (3.114),  It  is  found  that 

||p„(t|t)  -  P(tlt) II  <  •*XltIUa||*  ^~p  (l~a,Xlt) 

The  tlse-dependsnt  factor  reaches  a  maximum  whjeh  Is  detenined  by  nonsldaring 

s  [•“••(-“■•)]  -  •• 

This  ispllss  that  3e,Xlt  =  1  , 

so  that  the  aaxlmua  occurs  at 


(3.  117) 


(3.  118) 


(3.119) 


*  * 

The  aaxlauB  Is  easily  found  to  be  1,  so  that  the  maximum  difference  la 

l|P,(tlt)  -P(t|t)||<--^^"*  for  all  t.  (3.130) 

Tbs  difference  between  the  suboptlMl  and  optimal  error  covarlanaes  Is  seen  to  depend  upon  the  Initial 
uncertainty  5.  ,  the  slinal-to-nolse  ratio  as  described  by  ||KtR"1h||  and  the  iaallsst  time-constant  |\ , | 
of  the  flits?  dynamloe.  As  one  should  expect,  the  larier  the  Initial  uncertainty  or  the  better  the  aignal-to- 
nolse  ratio,  the  greater  the  error  Introduced  by  the  auboptlmal  gain.  On  the  other  hand,  If  the  filter  system 
has  a  large  time  oonetant,  the  auboptlmal  gain  dots  not  necessarily  cause  a  significant  detsrloratlon  of  filter 
ptrforsanae. 

To  summarize,  the  determination  of  the  steady-state  value  of  the  optimal  filter  permits  the  definition  of  a 
suboptlnal  gain  (l.e.  the  gain  of  the  Wiener  filter)  which  in  sany  casei  say  provide  satisfactory  filter  per¬ 
formance.  A  bound  on  the  norm  of  the  difference  between  the.  optimal  and  auboptlmal  error  covariance  matrlaes 
li  determined  which  Involves  the  Intuitively  obvious  element!  of  the  syetes  which  determine  filter  performance. 
More  extensive  dleoueelon  of  this  epeolel  problem  li  provided  by  Slnger,t. 


4.  CONCLUSION 

Is  Ms  concluding  section  the  Intent  Is  to  state  the  principal  rssults  and  the  highlights  of  Section!  2 
v,  3  In  order  to  allow  the  casual  rsader  to  aldsatep  the  morass  of  details  found  there  and  to  provide  a  support 
lor  ti«'  Norm  lnterestsd  rsader  with  whloh  he  uay  anchor  himself  at  he  elides  into  morses. 

'..  ton  1.1  provide!  a  statement  of  the  aathematloal  aodel  in  terms  of  Equations  (1.1)  and  (1.3)  and  then 
»"•  the  Unblued  Minimum  Variance,  Linear  Estimation  Problem.  These  upsets  shell  not  be  repeated  here. 


Seclion  5. 1:  /.inear  Prediction  and  Filtering 

Snot  Ion  2.1  cuntolnn  t  ho  solution  of  thu  problem  stated  In  Svotlon  1.2  In  term  of  t  bo  Kalmnn-Huoy  filter 
equetlomt,  Thin  Is  first  accomplished  in  Suction  2,1,  ualnn  arguments  which,  liopofully,  appeal  to  intuition 
and  provide  some  understanding  of  the  basic  character  of  th«  solution  This  dnvelopmont  Is  put  on  a  more 
rigorous  basis  In  Section  2.1.2.  wherein  the  proportion  of  the  measurement  residual  process 

E<t)  d  2(t)  -  H(t)£(t!t)  (4.1) 

are  examined  and  than  used  to  derive  tho  filter  equations  Thus,  In  the  first  two  paragraphs,  It  la  shown  In 
two  ways  that  the  solution  of  the  linear  filtering  and  redlotton  problem  stated  In  Seotlon  1.2  Is  provided  by 
the  system 

i(tlt)  =  P(t)*(tlt)  u  K(t)£(t)  ,  (4.2) 

"here  $(t0lt0)  =•-  E[xft0)l  , 

Tim  optimal  gain  K(t)  In  given  by 

K(t)  m  P(tlt)Ht(t)R'1  (t)  ,  (4.3) 

where  the  error  oovirlanoe  matrix 

Ktlt)  6  K<Lx(t> [*<t> -£<tlt>}T>  (4.4) 

Is  dsserlbsd  by  tho  mutrix-Rloattl  equation 

p  *  r(t)p  +  vrT(t)  -  piiT(t)R*‘<t)H(t)P  +  q(t)  ,  (4.5) 


whero  P(t0lt„)  =  M  . 

Some  additional  aspeots  of  the  filtering  problem  are  considered  in  Seation  2.1.3.  First,  the  eoncept  of 
orthogonal  projections  is  Introduced  slid  It  is  provsn  that  the  intimate  that  is  formed  as  a  linear  function  of 
data  iplnimlxes  the  mean-square  error  If,  and  only  if,  the  error  in  the  eetimate  le  orthogonal  to  the  data.  This 
result  le  used  to  derivo  the  wlener-Hopf  equation  for  the  system  (Equations  (1.1)  and  (1.2)). 

Next,  the  original  problam  la  generalized  to  allow  oroaa-oorralation  C(t)  between  the  plant  and  measursnent 
nolaa  prooeaaea  to  be  non -zero.  It  la  shown  that  the  correlation  causes  the  gain  matrix  K(t)  to  beoome 

*(t)  =  [P(t lt)HT(t) +  C(t)]R”1 (t>  (4.6) 

and  the  error  covariance  matrix  la  modified  to  become 

=  F(t)P  -  PFT(t)  -  K(t)[CT(t)+H(t)P]  +  Q(t)  .  (4,7) 

Tho  effect  of  a  deterministic  forcing  funotion  J(t)  in  the  plaut  li  considered  and  It  la  shown  thnt  this 
term  requires  a  trivial  change  to  tho  estimate.  Equation  (4.2)  la  modified  to 

i  =  P(t)l  t  lift)  +  K(t)l(t)  ,  (4.8) 

Finally  Seotlon  2.1.3  it  oonoludod  by  proving  tliat  the  conditional  naan  E[x(t)  IjJ(r)]  provide*  the  unbiased, 
minimum  variance  estimate- for  t  random  variable  g(t)  .  This  reeult  ie  useful  in  giving  a  probabllistlo  inter¬ 
pretation  of  minimum  variance  eutlmates.  For  the  linear  problem  described  in  Seotlon  1.2,  it  follows  from  this 
property  that  tho  unbiased  minimum  variance  eetimate  of  i(t>  for  the  eyetsm.  (Equations  (1,1)  and  (1.3))  la 
actually  a  linear  eetimate,  thereby  confirming  that  thu  linear  Kalman-Busy  filter  provides  optimal  estimate 
even  when  nonlinear  estlmatea  are  considered. 

The  tlme-dlsorote  system  equivalent  to  the  continuous-tlno  model  described  by  Equations  (1.1)  and  (1.2)  ie 
introduced  in  Section  2.1.4  and  the  filter  equatione  for  this  system  are  stated  without  proof. 

Section  2.  Sr  77i*  Colored-Noitt  Problem 

In  Seotlon  2.2,  the  whlte-noiae  assumptions  of  Section  1.2  are  relaxed  to  allow  the  plent  and  measurement 
nolee  processes  to  exhibit  corellatlon  between  different  tints  (i.e.  the  processes  are  oolored).  The  restric¬ 
tion  that  the  process,  soy  g(t)  ,  can  be  described  by  a  linear  shaping  filter 


In  Introduced,  however,  The  jr(t)  appearing  in  Equation  (4.9)  in  s  whlto-noiae  process.  Thu  oils*  of  problems 
with  eolorud-noiae  n  denoribod  by  a  shaping  filter  (Eqn  (4.9))  in  treated  by  nunmantintt  the  noise  variables 
to  the  state.  It  in  aeon  that  thin  approach  in  Bat  infactory  for  oolorod  plant  noise  blit  in  Inadequate  when 
there  are  measurement  data  whloh  do  not  contain  whlte-noiso. 

In  Section  2.9.3  the  solution  for  the  colored  measurement  noise  problem  is  determined  by  notino  that  the 
treatment  of  data  without  white-noise  la  aacompllnliod  considering  a  transformation  of  the  state  that  allows  the 
dimension  of  tho  filter  equations  to  bo  reduced.  Several  special  cases  are  treated  that  have  appeared  in  the 
literal urt 

Stction  2.3;  Linear  Smoothing 

To  oooplote  the  diaouasioi,  of  linear  eatioiation  theory,  tho  linear  emoothlng  problem  la  solved  using  tho 
innovations  (or  residual)  process  £(t)  introduced  in  Section  2.1,2.  It'  is  shown  that  tho  estimate  of  jt (t ) 
given  tho  dnta  Z(t)  ,  t  >  t  ,  hns  the  general  form 

X(tlr)  r  i(tlt)  +  P(t 1 1) <t>T(a. t)llT(«)H'' (H) r(»>  d»  .  (4.10) 

with  associated  error  oovarlance  matrix  described  by 

P(tlr)  4  E{[&(t)-i(t|r)](i<t)-J(t|T)]T>  r  P(t|t)  ••  P(tlt)M,(t,T)P(tlt)  ,  (4,11) 

there 

M,(t,r)  =  J't'V(a1t)H,r(s!R‘1(*)H(»)'t'(e,t)  da  . 

Equatlona  (4.10)  and  (4.11)  represent  the  general  solution  of  the  smoothing  problem  Three  olastes  of  smooth¬ 
ing  problems,  oharaotsrlzad  by  the  tims  t  at  which  tho  estimate  la  to  be  determined  and  the  interval  r  for 

whloh  data  axlata,  era  stated  and  the  solution  for  aaoh  is  givtn. 

.Section  3.1l  Obiervability  of  Determiniitic  Syitt a 

The  oonoept  of  observability  la  Introduced  in  terms  of  a  deterministic  linear  system  obtained  from  Equatlona 
(1.1)  and  (1.2)  by  considering  the  plant  noUe  g(t)  aa  known  and  the  measurement  noise  Y(t)  to  be  identically 

■ero.  If  all  atatea  j(t)  of  tha  datermlnliUo  syatast  oan  be  determined  from  knowledge  of  the  Input  g(r)  , 

t0  <  r  <  t  and  tha  output  $(t)  ,  then  tha  system  is  oomplataly  observable.  It  la  shown  that  the  system  le 
completely  observable  if,  and  only  if,  tha  observability  matrix 

M(t,,t)  =  Jj*  4V.t0)HT(T)R’l<r)H<r)$(r,t0)  dr  (4.12) 

is  positive-definite  for  some  t  >  t„  . 

When  the  linear  system  la  stationary  it  ia  shewn  that  the  observability  criterion  oen  be  expressed  in  tarns 
of  tbm  n  x  an  matrix 

U  =  [HtPtHt.  ...(PT)d'1HT]  ,  (4.13) 

The  ayetem  la  oomplataly  observable  If  this  matrix  has  rank  n  . 

In  Seoi-ion  3.2  it  la  shown  that  tha  Isast-aquarea  estimate  of  an  arbitrary  initial  state  exists  if  tha  ayetem 
is  oomplataly  observable.  That  la,  a  lasst-aquaras  estimator  exists  if,  and  only  it,  the  observability  matrix 
la  positive-definite. 

Section  3.2;  The  Natrix-Ricatti  Equation 

Tha  error  covarlanoa  matrix  was  found  in  Saotion  2  to  be  described  by  a  metrix-Ricattl  aquation.  This  non¬ 
linear  aatrli  differential  aquation  is  investigated  In  this  aeotlon  and  it  is  shown  that  it  oan  be  rewritten  by 
a  system  of  linear  matrix  differential  aquations.  Thus,  the  matrix-Rioattl  equation 

P  *  P(t)P  +  PTT(t)  -  PHT(t)R-‘(t)H(t)P  +  Q(t)  ;  P(t0)  =  P„  (4.14) 

oan  b«  written  aa 

*  *  P(t)Y  +  Q(t)Z  J  Y (t0)  =  P0  (4.18) 

Z  =  Ht(t)R'*(t)H(t)Y  -  PT(t)Z  ;  Z(t„)  *  I. 


(4.  IS) 
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Th«  eolulion' of  Equation  (4,  14)  li  obtained  from  tho  aolutlona  of  Equations  (4.15)  and  (4.101  an 

P(t)  e  Y(tirl(t)  .  <41 

Mora  expllolt  aolutlonn  oan  bo  obtained  when  either  H(t!  or  Q(t)  vaniali.  These  aolutlona  aro  derived. 
Alao,  additional  lnaighta  ora  possible  Into  the  oharaotar  of  Equation  (4.14)  »hen  thn  system  la  atatlonnry. 
Thla  special  oaaa  la  dliouaaod  In  aom#  detail. 


Section  ,1.3:  BounJe  for  thr  Error  Cauarianoc  Matrix 

The  error  covariance  matrix  provides  the  prlmnry  statistical  measure  of  tho  performance  of  the  aatlmntnr. 

This  atatlstlo  la  aotually  Independent  of  tho  monsurorant  data  so  It  cnn  be  Invest Uatnd  bofore  tho  Kulamn-Buey 
tutor  oquatlona  aro  used  to  proooas  data  for  a  given  system,  tlppur  and  lower  hounda  for  this  matrix  aro  estnb. 
llshod  In  this  system  In  such  a  manner  that  tho  fundumontully  different  roles  of  the  plant  noise  and  tho  inonsuri 
ment  noise  processes  are  clearly  displayed.  It  la  shown  thnt  P(tlt)  Is  bounded  below  by 

P(tlt)  >  'Kt,ta)[P'0‘  +  N(t0,t  ll_l  #T(t.  t0)  +  Pp(tlt)  .  (4.18) 

where  pP(tlt)  la  a  non-ne*atlve-definite  (nover  posltlve-definlto)  matrix  sod  thu  flrat  term  vanishes  as  t 
becomes  large  for  q-observatile  systems,  (This  term  is  defined  in  uootion  3.3.)  The  uppor  bound  is  (Ivon  by 

P(tlt)  <  «(t,t#)[p;,4-B(t„,t)l*,«T(t1t#)  t*(t0it)  ,  (4.18) 

whore  the  stooheetlo  controllability  matrix  *<t0,t)  ia  defined  to  be 

W(t„,t)  £  *(t,T)<l(r)4',(t,T)  dr. 


Action  3,4/  B'hovior  of  tha  Error  Covorianco  for  Stationary  Syittti 

The  error  oovarlanoe  matrix  for  etatlonery  systems  oan  be  atudled  in  more  detail  using  ths  steady-value 
11s  P(tlt)  =  Prt  .  A  iuboptlmal  gain  K,  equivalent  to  the  Wioner  filter  gain  oan  hs  defined  that  le  useful  In 
examining  the  influences  that  sffeot  the  relative  performance  of  the  optimal  end  Wiener  f mere.  Letting  Pw(tlt) 
denote  the  error  oovarlanoe  matrix  of  a  filter  uaing  the  oonatsnt  flaner  gain,  It  le  ehown  that  the  difference 
la  bounded  by 


n  ,  II  Pa  «  1 

ikf<tit>  -  p(tit)||  < - 


for  all  t 


(4,20) 


where  8.  *  F(t0)-P,„  ,  and  where  ||htIT1h!I  repreeenta  the  signal -to-noise  ratio  of  tha  meaeuremant  ayatem  and 
|\J  la  the  emalleat  time  oonetsnt  of  the  filter  dynamloa. 

Thle  concludee  a  aumnary  of  tha  preaantatlon  found  In  'Ssotlone  2  and  3.  Many  topioa  hava  been  omitted  from 
thla  dlaoueaion  and  other  toploe  have  been  dealt  with  eoaewhat  superficially.  Many  of  tlieee  omissions  and 
auparflolalltlea  ara  given  their  deserved  siring  in  subaequent  chapters  snd  their  variety  and  number  provide 
tt)  indication  of  th«  brtadth,  d«pth,  and  i*port'anc«  of  unbiased,  minimun  varUnoa  Xinaar  Mtiaation  tnaory  in 
•nfinatrlni  thsury  and  application. 
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CHAPTER  1  FURTHER  CURRENTS  ON  THE  DERIVATION  OP  KAI.MAN  FILTERS 


SECTION  I  -  DERIVATION  OF  THE  KAI.MAN  Pli.TERINCJ  EQUATIONS  FROM 
ELEMENTARY  STATISTICAL  PRINCIPLES 

P.  II,  Barham  and  D.  E.  Humphrieu 


1.  INTRODUCTION 

Iu  less  than  a  docndo  Kalman  filter iuu  baa  booome  an  catahliahod  technique  within  the  resources  or  the  Acronpaoo 
eyetems  designer,  Unfortunately  tho  fact  that  it  la  an  advauued  atatlitioal  concept,  mainly  doaorlbed  by  maths- 
matlolana  on  the  asaunption  that  tha  roader  la  familiar  with  advanced  statistics!  theory,  haa  too  often  had  the 
•ffeot  that  the  praotical  engineer  has  aooepted  a  met  of  equation*  while  feeling  lneufflalootly  qualified  to 
attempt  a  full  appresletlon  of  thalr  elgnlf loanee.  The  ala  In  thla  chapter  la  to  provldt  a  eltnpls,  though  rigoroua, 
derivation  of  the  Kalman  filtering  equations  In  a  form  which  ahould  appeal  to  tha  leg*  mathematical  reader.  For 
thle  fi'-'on  more  etepa  have  been  Included  in  the  derivation  of  tha  equation!  than  would  he  neoeeeary  for  thoa* 
fully  ta-  liar  with  etatlatlcal  methode. 

hu  naoeiaary  atatietical  theory  la  ft  'alopad  in  Sesti»e  3  a*  an  extension  of  familiar  and  llemantnry  a amp ling 
theory.  Vharaaa  a  knowledge  of  alegile  m  -.rix  notation  am.  manipulation  in  unavoidable  for  the  development  and 
applloatlon  of  the  practical  multi-dimer donal  flltfr,  the  theory  la  first  developed  for  a  aiopla  elngle-dlmenalon 
oaae  which  lead*  directly  from  the  oon'.ptn  of  mean  value  and  standard  diviatiou. 


I.  OPTIMUM  COMBINATION  OF  INDEPENDENT  ESTIMATES 

The  Kalman  filtering  prooeaa  conaiate  of  oomblning  two  independent  eatinatee  of  a  variable  to  form  a  weighted 
■moati.  The  weighting  factor  la  oboaen  to  yield  a  mean  with  minimum  variance  and  hsnee  maximum  probability.  Ona 
of  tha  eatlaatea  le  derived  by  updating  a  prgvluuc  beat  eeUmate  in  aooordunce  with  the  known  equal, lone  of  motion 
and  the  other  estimate  le  obtained  from  a  meaauraaent.  The  form  of  tha  required  weighting  factor  la  derived  below, 
flrat  for  a  alnila-dlmenalcn  oaae  and  aeuondly  for  the  general  aultl-dimensional  forai  required  lor  the  Kalman  filter. 


S. 1  The  Slngle-Dimeesion  Caee 

Let  g,  end  x,  •  be  two  Independent  estimates  of  a  quantity  a  with  variances  erf  and  crj  rei.peotlvely. 

It  la  required  to  combine  these  estimates  to  fora  a  weighted  mean  oorrsaponding  to  the  overall  bast  estimate  (t) 
whart  "beat  eatimata"  mean*  tbe  minimum  variance  estimate. 


Now  the  general  rora  of  tha  walghted  mean  of  xt  and  g,  1* 

X  s  (l-W)*,  +  WX,  , 

Thu*  tha  expected  or  mean  value  of  I  [written  E(l)l  lw  given  by 

Ed)  =  (1-w)  E(Xj)  '+  wE(Xj)  . 

By  definition  the  varianoe  of  a  quantity  x  1* 

eKs-EU)}']  , 

Honot  tha  variance  (o')  of  X  la  given  by 

c 9*  3  *[ft-«d))']  »  e[{(1-w)*i  f  WX,  -  (l-w)!!!,)  -  UCC*,)}*] 

3  l[(l-W),{x,  -E(X,)}*  +  W*{s,  ■>E(X|)]*  -  2*(1  -w)  {x,  -  E(xt)}{x,  -E(lj)}] 

3  «-■)*■[{*, -■(*,)}*]  +  W*«[{*, -«<*,)>*] 


or 

slnoe 

aa  Xj 
valut  of  w 


er*  •  (l-w)V|  +  w‘aj 


d.  1) 


(2.2) 


(2.3) 


(2.  4) 


and 


‘  *[{»,-■(*,)}{*, -E(x,)}]  a  0, 

x,  art  indapendent  estimates  so  thit  (x 4  -  E(x  4) )  and  (x, -E(x,)}  are  unoorrelatad.  To  determine 
for  which  t t1  la  minimum,  Equation  (2.4)  may  be  partially  .llfferantiatad  with  reepeot  to  w  .  T1 
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livlni  the  optima  value  t  of  weighting  factor  as 

•  * 

nubetltutlon  in  Equation  (3. i)  ilv«* 


o'?  +  a?. 


f**  J.  rr* 


and  is  Equation  (3,  i)  give*  the  variance  of  f  ai 

»•  x 


oT~°y 


(2.6) 


(3.6) 


(3.7) 


If  a,  it  cone'dwrod  to  ba  a  menaurement  used  ta  iaprove  an  updated  •■instate  ti  ,  Equation*  (2.')  and  (2.7)  can 
be  put  into  th«  nor*  convenient  forma 

t  -  at-«(x,-i,)  (2.8) 

and  a'  =  aj(i-t)  , 


<3.0) 


vhioh  aor*  olias  lor  ahow  how  the  eitiiit*  and  ita  varianoa  are  "lapravid"  by  the  mea*uren»nt  in  readinea*  for  further 
updating.  Equation  (3. 6)  nlao  ihown  the  olaie  analoiy  ta  negative  feedback, 

1. 1  The  KuHl'DiMitiiotMl  Cum 

Let  X.  and  X,  be  two  n u 1  natrioei  representing  two  independent  eetinatei  (i.e.  with  unoorrelated  errora) 
of  an  n-dinenaluna!  vector  quantity  X  .  Pk  and  P,  are  two  nxn  aatrioae  repreaenting  the  variance*  of  Xt 
and  X,  reepeutlvely. 

In  gecerai  the  weighted  aeon  of  Xt  and  X,  ie  given  hy 

S=  (I-»)X(  +  fX, 

X  ■  Xi  -  *(Xt-X,)  ,  (3,10) 


or 


wheje  W  in  an  arbitrary  nan  weighting  matrix  and  I  .  lx  the  unit  aatrlx.  The  beat  eatiaate  of  X  (denoted 
hy  X)  will  be  .given  by  (3. 10)  when  W  ie  ahoeen  no  that  the  variance  of  X  in  a  minimi®  in  the  eanoe  ooneiderwd 
below. 

in  aany  practical  aoaei.  however,  the  two  eetluates  are  hot  of  equal  dlaenaiona,  one  of  then  being  some  function 
(H,  eay)  of  the  Individual  eleaeute  of  X  (for  exaule,  a  maeureaent  relating  to  none  only  of  the  elenente 
of  X).  In  general  M  may  be  au  nun  rectangular  Matrix  operating  on  X  to  give  in  B-dUennional  eetlmata  x  ■ 

The  general  problem  thereto.*  1*  that  of  forming  on  optimum  eatiaate  (X)  of  X  from  one  eatiaate  (X,  with 
varlanoe  V)  of  X  and  an  eatiaate  (Y,  with  varltnoe  V)  of  Y(«MX)  .  If  wa  lot  the  weighting  aatrlx  in  (3.10) 
be  »  *  Ell  .  where  X  ie  another  arbitrary  weighting  aatrlx,  then 

S  *  X,  -  UKX,"X,) 

»  Xi  -  X(kX,-Y,> 

*  (I-UOXj  +  XY,  .  (2.  il) 

fer  definition  the  varltuoe  P  of  S  in  given  by 

P  w  i{B-E('i)]ni-l(S)]T} 

end  eiallor  expreaeiuoa  eay  be  written  for  P'  and  V  .  thi  verlonoee  of  X,  end  1,  reipeotlvely,  where,  ee 
in  fleotiou  3,1,  E  denote*  the  expeoted  or  Mon  value,  lubetltutlng  for  X  froa  Equation  (3.11)  w*  have 

t  •  bU<X-KH)X|  +KY,  -  (l-KBNKX,)  -  U(Y,)]t{I-XH)Xt  +XY,  -  d-KJDKX^  -  «(Y,)]T> 

»  <I-OI)E([xl-*(Xl)][x,-B(Xi)]t)  (I-M)f  +  KB{[Y,-E(Yt)]  [Y, -E(Yj)]t>X*  , 

einoe  X,  and  Y,  are  unoorrelated.  Thu* 

P  »  (l -XM)P'(t-XM)*  +  KVXt  .  (3.12) 

It  la  now  required  bo  find  the  value  of  X  wqioh  alulaiaea  P  in  the  eenae  that  each  diagonal  element  of  P 
(ball  be  a  alnlaun  varltnoe.  Expanding  Equation  (I. 12)  give* 

P  x  (I-MOP'd-XN)’  +  XVXT 

«  p'  +  (XB)P'(nrr  -  duop'  -  p'(km)t  +  kvkt 

*  P'  +  K(UP'Ht  ♦  V)K*  -  K(MP')  -  (HP')tXt  , 
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l>  f.  it 


ainoe  (AB)t  r  bTAT  and  p'  la  a  symmetrical  matrix  eo  that  P'T  =  p'  ,  Now  consider 
(KS-A)(KS-A)T  a  K(SST)KT  -  KJSAt  -  AStKt  +  AAt 

■=  K(GaT)KT  -  K(SAt)  -  (SAW  +  AAt 
=  K(MP'MT  +  V)KT  -  K(MP')  -  <MP')tKt  +  AAt  , 

it  sa1  =  m>'mt  +  v 

and  HAt  =  MP'  , 

whence  ¥  =  P'  +  (KS  -  A)  (KS  -  A)7  -  AAT 

*  P'  +  (KS-A)(KS-A)T  -  P'Mt(MP'Mt+V)‘‘mP'  .  (2.13) 

The  only  term  In  this  expression  fur  F  which  la  dependent  on  K  le  (KB  -  A) (KS  -  A)T.  Aa  this  In  of  the  form 
BBt  ,  the  diagonal  elements  consist  of  the  sums  of  squares  of  the  Individual  elements  of  (KB- A),  and,  as  such, 
cannot  have  negative  vnluee.  Thus  each  diagonal  olomout  of  ¥  shall  be  a  minimum  varlanuo  If  K  takes  the  valuo 
which  autkos  (K8-A)  =  0:  that  le,  If 

K  =  P'Mt  LMP'MT  +  VJ " 1  .  (2.14) 

Substituting  in  Equation  (2.  13)  with  (KS-A)  3  0  gives 

Pape  P'-KMP'  (2.18) 

as  tho  variance  for  the  beat  estimate  of  X  which,  from  Equation  (2.11),  beaomes 

if  *  Xt  -  KOtX^t,)  ,  (2.18) 

where  K  takes  the  value  given  In  Equation  (2.14). 

3.  REPRESENTATION  OF  PlIVStCAL  PROCESSES 

Classical  physios  tails  us  that,  in  ths  sbasnes  of  external  disuurbxnee,  the  future  behaviour  of  a  system  may 
bo  derived  from  its  present  etste  by  application  of  ths  known  aquations  of  motion.  It  la  now  realised  that,  due 
to  tho  quantum  nature  of  fundamental  physical' processes,  this  is  only  effectively  true  in  ths  maroo  ossa  when  ths 
quantum  noise  .can  be  ignored  and  only  tho  statistical  «ian  need  be  considered,  tutors  .this  is  not  th*  csss  ths 
sxpsctsd  or  main  state  of  ths  ayatam  may  bs  predicted  hy  the  equations  of  sotion,  but  imposed  upon  this  will  be 
t  random  contribution  due  to  quantum  events,  whose  probability  distribution  only  will  bs  known. 

Similar  considerations  apply  to  any  external  disturbance,  soma  of  these  are  predictable  and  can,  if  desired, 
be  included  aa  parnmatera  within  our  chosen  system;  this  will  also  apply  to  any  bias  which  may  be  preaant  in 
otherwise  unpredictable  disturbances.  It  is  thus  naan  that  ths  behaviour  of  any  physical  ayatam  may  bs  consldarad 
to  consist  at  one  part  which  is  precisely  predictable  from  tha  known  equations  at  motion  and  a  second  part  which  la 
random  about  aaro  mean,  but  whose  probability  distribution  nay  be  determined,  fuch  a  procaas,  in  which  tha 
statistics  of  tho  future  babavluur  of  a  ayatam  are  purely  a  function  of  tta  state  nt  a  particular  time  and  the 
statistical  structure  of  the  perturbing  pruceaa,  le  termed  a  Markov  Prooaaa.  It  la  olaar  that,  by  a  suitable  ohotoo 
of  tha  variables  included,  any  phyalaal  prooaaa  can  be  represented  in  tbie  way. 

Aaaumlng  a  Markov  prooaaa  of  this  kind,  its  trua  state  Xktl  at  ties  tk+l  may  be  represented  ae 

xk*i  +  *kxk+0k°k'  OD 

share  Xk  wee  Its  true  state  at  time  U  .  Here  Xk  and  Xktl  are  n  x  1  matrices  representing  the  n  parameters 
necessary  to  daflns  tha  atata  of  tha  ayatam  (tamed  tha  atata  vaotor). 

$k  la  an  nxn  matrix  raprexenting  the  known  dynamics  or  equations  of  motion  of  the  uyetem  (termed  the  transi¬ 
tion  matrix). 

Ul  rapreaauta  the  random  inputs  (with  aeru  meant)  to  tha  system.  In  general,  if  there  are  1  aouroaa  of  random 
input,  Uk  will  he  an  I  x 1  matrix  and  la  known  aa  plant  noise. 

Qk  ia  an  n  x  1  matrix  rapreaanting  the  atfaota  of  tha  1  element*  of  nola*  on  th*  0  psramatora  of  th*  ayatam. 


Tha  ohoioa  of  slamenta  to  Include  in  tha  atata  v 
should  include  all  tha  systematic  alamente  and 


Ak  annum  lnciuca  aei  une  ajaiemanu  axamente  anu  ok  a  11  one  rnuun  eieoenva  uiieebuu*  cue  system,  ulid  itasii 
is  a  choice  tfjptndent  upon  the  state  of  the  art.  Many  sffeati  whioh  wart  considered  random  or  unpredlotabia  a 
oentury  age  kf^ now  well  undaratood  processes,  On  tha  othar  hand  aomt  influences,  although  fully  understood  and 
prwdlotable,  may  be  to  remote  from  the  myetem  under  consideration  that  their  effaote  may  conveniently  be  included 
aa  part  of  tha  random  Input. 

The  representation  of  a  Markov  process  by  Equation  (3. 1)  dees  not  necessitate  n  stationary  random  prooaaa.  Tha 
term  of  4k  and  Qk  end  tbs  statistical  atruoture  of  Uk  (l.e.  its  variance  Qk)  may  vary  (roa  step  to  step. 
Indeed  the  requirement  la  not  ao  much  that  they  should  be  constent  even  within  a  tingle  step,  provided  that  the 
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otor  ia,  in  praotioa,  lomawhat  arbitrary.  Although  thaoratioally 
Uk  all  tha  random  slamenta  affecting  the  eyitem,  thin  itself 
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Integrated  of  frit  shall  ho  kt  own  for  each  indivldunl  atop.  In  moat  cases,  of  oourso,  tlm  step  nlzo  will  bn 
ohonn  to  ensuro  that  the  transition  matrU,  thn  vurlenet  uf  tint  plant  noUe  and  Its  effnot  on  thu  system  may  all 
bo  considered  oouotnnt.  finally  la  should  ho  noted  that,  00  tho  stop  alzo  approaches  tlm  zero  limit,  liquation  ('1.  1) 
ootlapaoa  to  tho  mure  familiar  differential  form, 

4.  nemVATtON  Of  THE  KAI.I1AN  FILTER 

It  la  nooeneary  to  oonnidor  three  quite  dlatlnot  sots  of  equal  Iona  In  ordor  to  devise  the  Kalman  flltur.  first 
»a  must  represent  the  true  atato  of  tho  system  In  order  to  he  able  to  study  Its  statistical  struoturu.  Hoomidly, 
wo  must  consider  how  we  may  forooaat  thu  state  of  the  ays  tern  from  a  previous  bust  estimate  and  what  variance  this 
forecast  will  have,  finally  we  muat  dommlne  a  bust  uHtimatu  uf  the  updated  statu,  together  with  Its  variance, 
by  sultnbly  oombinlng  Its  forecast  value  with  a  measuromant. 


In  this  and  aubsequont  sections  truu  values  will  bo  represented  by  non- accented  characters  such  as  Xk 


fore¬ 


oast  value  which  has  notboon  subducted  to  a  measurement  will  bo  represented  by  a  prlaio  (o.g.  X'kll)  end  a  boat 


satlmate  by  a  hat  (p.e.  xkt|).  Where  a  moasuromont  la  available  this  last  will  he  obtained  by  combining  the 
forecast,  with  thu  measurement.  In  tho  absonce  of  a  muasurement  tho  forecast  valuo  will  Im  the  best  estimate. 

4,1  The  True  State  Equations 

Da  have  alraaily  shown  In  Saotion  3  that  the  true  atats  Xktl  at  time  tk>1  is  derived  from  its  state  Xk  at 
tlma  tk  by  ths  equation 

Xkn  a  Vlt  +  Qkuk  ■  (4,11 

Hors  4k  ,  the  transition  matrix,  Is  known,  as  is  8k  representing  ths  stfeot  of  a  noise  Input  on  tho  nlomonta 
of  the  stats  vsetor.  We  know  that  atatlatlcally  Uk  has  a  zero  moan  and  variance  dk  ,  hut  wt  have  no  knowledge 
of  ths  actual  nolss  contribution  Uk  to  this  particular  stsp, 

Similarly,  whtn  wo  make  a  measurement,  the  quantity  measured  will  be  10ms  function  Mku  of  the  Individual 
elements  of  the  state  veotor,  but  the  actual  reading  will  also  have,  a  noise  contribution  Nkfl  .  Thus  tho  aotual 
quantity  Uotermlned  by  the  msasuromunt  will  be  In  the  form 

*kel  *  *k»i*ka»  +Nk*i  •  <4.a> 
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Mk<1  is,  In  oenoral,  an  use  matrix  which  operatsa  on  the  n  elementa  of  Xk<J  to  give  the  mxl  matrix 
rapreuenting  the  m  elements  of  the  measurement  Yk  .  .  In  most  eases  MkM  will  be  a  simple  row  matrix  yielding 
a  Tingle  paramstsr  fur  msaaursmsut  and  frsquuhtly  all  slameutu  of  the  row  except  one  will  be  zeros,  eu  that  the 
sffuot  uf  Mk+1  will  be  to  Isolate  a  single  element  of  XkM  .  Nkkl  ls  the  "measurement  noise"  and  has  zero 
mean  with  varlanas  Rkkl  ,but  the  actual  contribution  to  a  particular  measurement  is  unknown. 

We  are  then  able  to  describe  the  true  behaviour  of  the  system  by  Equation  (4. 1)  and  of  the  measurement  process 
by  (4,2), 

4,2  Tee  Forecasting  Process 

If  ths  error  In  Xk  (ths  best  estimate  uf  thn  true  stats  Xk)  to  «k  ,  then 

Xk  s  Xk 

Bines  ths  plant  noise  Uk  has  zero  mean.  It  is  easily  seen  that  the  best  forooaat  la  simply 

xiwi  ~  'Mk 

»  4kXk  +  4k«k 

e*  Xktl  -  QkUk  F  4k«k  ,  (4.3) 


Kk  ,  will  have  the  same  variance  as  Xw  Itself  (l.f.  Pk)  and  hsnoe  ths  variance  of 
Uarly  ths  variance  of'  3  Uk  is  akQkQk  ,  whore  Qk  is  ths  varianoe  of  Uk  .  Thus, 


Now  <k  ,  the  arror  of 

$k<k  la  $kPk4k  .  similarly  ths  varianoe  of  3  Uk  is  okQkQk  ,  whore  (lk  1 e  ths  varianoe  of  Uk  .  Thus,  since 
XkM  Is  a  true  vtlus,  the  error  ol'  Xk<p|  Is  veprsiented  by  the  last  two  terms  of  Equation  (4,3).  Ulnae  these 
two  error  terns  (original  error  and  error  Increment )  are  Independent,  the  variance  of  XkM  la  given  by 


pk.i.  =  Wk  ■ 


(4,4) 


the  beet  estimate  of  X 


k»i 


will  ba 


^kti  ‘  *k*i  ~  xk+i  (**k»  ixk*  1 _  Jk*l)  1 


(4,9) 
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4. 3  The  Measurement  Process 

Ths  maasursmsnt  prooms  consists  of  a  determination  of  XkM  ,  which  is  defined  in  Equation  (4.2),  and  comparing 
this  with  a  forecast  (Xk.,)  In  order  to  obtain  a  best  uutlmate  (Xktl)..  Now  using  Equations  (2.14),  (2.19)  and  (2.  13) 
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rk+  i"k+ 1  l"k*  irk*  i  +  Rk+  J 


and  RkM  la  the  variance  of  Yk>l  . 

The  variance  of  Xk<1  la  given  by 

P 


k*i 


=  PkH  -  l£k*i*’k*ipk*< 


8.  CONCLUSION 

If  the  true  atate  of  a  Markov  prooeaa  and  a  meaauromont  are  definnd  by  tho  equatlona 

Xk4l  :  4>kXk  +  OkU„  . 

whore  Xk  la  tho  atate  vector  at  time  tk 

#k  la  a  tranaltion  matrix  reiirnaentlnc  the  equation  of  motion 
Uk  in  the  plant  noise  with  variance  Qk 

ak  repreaonla  the  effect  of  the  noiae  Input  on  the  atati  vector  and 


*k*i 


=  Mu.Xk<1+N, 


k+i 


where  YkM  la  the  quantity  moaaurad 

Mktl  reprceente  it  a  relatlonahip  with  X^j 
l.‘kM  ie  the  meaauromont  nolas  with  variance  RkM 


<4.  6) 


(4.7) 


(5. 1) 


(5.11) 
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then  the  beat  eatimate 

£k  of  the  ayatem  and  lta  variance  Pk  can  be  updated  by  tho  equatlona 

*  e  '  i 

XkM 

= 

¥k 

(S3) 

:>$ 

Pk*! 

= 

WS +  wS 

(8,4) 

a  j  k 

Kk>l 

= 

pk..«k.i  r«k*ipk*rMJ*i  tRk+i^'1 

(5.5) 

Hi 

and 

^kel 

.5 

K.i  -  K^i  «b*iHiwi-Xk.») 

(5.8) 

kaffl 

rrT* 

a 

nv:; 

Pk.l 

= 

pk*.'  “  Kk»  lMk*ipk*i  • 

(5.7) 
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NUTATION 

•j  generalized  noise  vector  random  varlablo  corrupting  the  generalized  moasuremunt  z*  of  the  state  Xj 

ej  gonorellzed  noise  vector  random  variable  corrupting  the  generalized  meuaurnmont  z1’1  of  the  state  Xj 

f{  deterministic  voctor  forcing  function  in  discrete,  linear  dynamical  system  at  tk 

Qj  eigenvector  corresponding  to  eigenvalue  Xj  of  matrix  M 

tjj  tth  sampling  time  ■ 

v  random  noise  vector  varltble  corrupting  tho  meseursmert  z  of  tho  constant  state  x 

vk  kth  random  vector  variable  formed  by  partionine  v  In  subvrotora 

Vj  white  nuise  seyuotioe  corrupting  measurement  zj  at  tj 

v1  generalized  random  vector  variable  formed  by  grouping  tho  Vj  lor  1  running  from  1  up  to  1  In 

one  vector 

white  nnlae  sequence  affecting  discrete,  linear  dynamical  system  at  tkM 

w1'1  generalized  random  vector  variable  formed  by  grouping  the  «tsl  for  1  running  from  1  up  to  1  in 

on*  vector 

x  constant  state  vector 

Xk  estimate  of  x  based  upon  the  It  first  mesvurement  subvsotora  \ 

xt  state  of  dlaarste,  linetr  dynamical  system  at  tj 

a1  generalized  state  vector  formed  by  grouping  the  Xj  for  1  running  from  1  up  to  1  m  ono  vector 

aetlmate  of  xt  based  upon  z1 

i{  estimate  of  x1  based  upon  t*"1  (extrapolation  of  S(_ ,) 

Tj  auxiliary  vsetor  defined  by  =  P1y1 

y[  extrapolation  of  y1.l  from  t1.1  to  tj 

I  measurement  vector  of  the  stats  x 

litl*  .^ssurement  subvector  formed  by  partitioning  z  In  aubvsotors 
Zj  Muursmept  vsotor  of  the  stats  xt  tt  time  tt 

i1  generalized  measurement  vsotor  formed  by  grouping  the  zk  for  t  running  from  1  up  to  1  In  one 

vector 

Ct  oovarlsnoe  matrix  of  et  ,  C(ete[) 

C{  oovmrlanoe  matrix  of  e[  ,  Kt(mJ )(e|)"tl 

Cj  gain  matrix  for  aooumulatlvs  filter 

Pl  auxiliary  matrix  defining  a1  as  function  of  il‘l  and  v1  ,  »k  =  -  H1?1*1"1  +  v1 

H  observation  matrix  of  state  x 

eubmatrlx  of  H  defined  by  zk  a  Hkxk  +  vk 
Hj  obeervatlon  matrix  of  state  xt  at  ti 

H1  gantralized  observation  matrix 

K),  gain  matrix  for  Kalman  filter 

M  non-negatlvs  definite  matrix 

P  covariance  matrix  of  the  error  (x  -  x) 

•  v» 


covariance  matrix  of  tin  error  (xk  -  x) 

covariance  matrix  of  the  error  (£j  -  xt) 

oovarianoe  matrix  of  the  error  (x{  -  x4) 

oovarianoe  matrix  of  Wj.j 
oovarianoe  matrix  of  v1'1 
oovariaree  matrix  of  v 
oovarianoe  matrix  of  vk 
covariance  matrix  or  vk 
oovarianoe  matrix  of  v1 
poaitlve  definite  weighting  matrix 
jth  elginvalue  of  N 

state  transition  matrix  fron  t1.1  to  tj 
■eneralised  state  transition  natrlx 
Identity  matrix 
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CHAPTER  2  -  FURTHER  COMMENTS  ON  THE  DERIVATION  OF  KALMAN  FILTERS 
SECTION  II  -  0AU6SI AN  ESTIMATES  AND  KALMAN  FILTERING 

Y.Ocnin 


1.  INTRODUCTION 

Tbr  aim  of  thlB  contribution  la  twofold.  First,  it  will  (tvs  the  tsarfnr,  who  In  familiar  with  mean  squares 
techniques,  sufficient  background  to  gain  easy  uoceaa  to  Kalman  filter  theory.  To  this  end.  the  intimate 
connection  batwocn  the  Kalman  and  the  Oausslan  estimation  theory  will  he  (jointed  out:  mors  precisely,  it  will  be 
shown  that  the  application  of  rotulta  obtained  by  Qnuas,  at  least  In  eaaenci,  to  discrete  stochastic  linear 
prnoestea  lead*  to  the  Kalman  filter. 

The  flrit  part  recall!  the  main  points  of  the  Oauaa  theory*,  aa  aliihtly  extended  by  Plackett1*.  The  core  of 
this  section  la  a  restatement  of  two  classical  theorems,  which  ara  of  primary  importance  in  modern  linear  filterlni 
techniques:  the  first  constitutes  the  cornerstone  of  recursive  filterlni,  while  the  second  offers  itm  dual  form, 

I,*,  accumulative  filterlni. 

The  leoond  part  la  devoted  to  the  application  of  thus  theorems  to  dlaorate  stochastic  practises  and  shows 
how  the  Kalatn  filter  and  its  dual  form  fit  naturally  in  the  framework  provided  by  oauea. 


I.  THE  GAUSSIAN  LEAST  SQUARES  THEORY 

2.1  Itateaenr.  of  the  Problem 

-Consider  the- ig,U  owing  .aquation  .of  jwaaurameuti: 

a  *  Hx  +  v  ,  (1) 

where  s  la  a  N-dlnensional  veotor  of  measurements ,  x  a  n-dlmanaional  constant  state  vector  to  be  determined 
(it  <  N),  H  a  Nan  matrix  of  aaxlmal  rank  and  v  a  N-dlnenslonal  veotor  of  errors  with  aero  mean  and 
positive  definite  covarlanoe  matrix  It  . 

The  problem  it  to  find  an  intimate  5  of  ths  unknown  state  x  aa  a  linear  combination  of  ths  msaiuramanti  a  , 

*  s  A*  ,  (2) 

so  that  the  estimate  i  be  unbiased  end  have  the  smallest  variance  for  each  of  lti  elomcnts. 

1.2  A  Deterministic  Problem 

let  us  oonnlder  a  particular  problem,  In  which  Equation  (1)  holds*.  The  z  veotor  la  known  and  is  assumed  to 
take  the  value  I  .  Let  ua  temporarily  dlsragard  probabilistic  and  atatlxtlcal  considerations  and  seek  a  "good" 
approximation  X  of  the  state  x  ,  in  the  form  of  a  linear  combination  of  the  known  measurements  t  .  If  we 
arbitrarily  decide  to  measure  the  quality  of  the  approximation  by  adopt Inc  the  usual  mean  aquaraa  criterion 

(X  -  HI)t!(*  -  HX)  =  minimum  ,  (3) 

with  W  a  positive  definite  weighting  matrix,  the  beet  epproxlaatton  la  readily  found  to  be 

x  =  <HTmrlHTi*  .  (4) 

wbloh  uolvea  this  simple  deterministic  problem, 

2.3  Ihecrwa  1 

Coming  back  to  our  main  problem  (Seotton  2.1),  we  shall  now  prove  the  following  fundamental  theorem.  Tht 
unbiased  estimate  x  .  which  it  a  tidear  combination  of  th*  ntatumtntt  t  and  hat  tht  isalUjt  va rianei  for 
each  af  its  compontnt  a ,  it  |iv<n  by 
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1  =  (hVh)"‘htR'1x  . 


(5) 


It  hoi  the  tarn  form  a  i  Squat  ion  fit),  the  lolution  of  the  determtniii Ic  problem  in  which  the  weighting  matrix  V 
it  eel  equal  to  R"1  , 

The  oatimate  U  readily  proved  to  be  unbiased,  (or  Its  mean  value 

Nil  =  (MtR”*H)  ‘'h'r'  *((*) 

nay  be  written  in  Vis*  of  equation  (1), 

1(8)  =  OItR*1M)mIItR*1[Hx  +  K(v)] 

=  X  .  (8) 

Ttio  covariance  matrix  P  of  the  estimate  8  Is  defined  by 

P  *  EtiS-XHl-x)*] 

thloh,  In  this  oase,  has  the  form 

P  «  (HTR'lH)'lHTR*li(vvT)R"lH(H,R"1H)‘t 

*  (HVH)'1  (7> 

Before  provlni  that  saoh  diagonal  element  ot  the  P  matrix  is  minimised  hy  Equation  (5),  let  us  first  sstablish 
the  followlni  Important  lemma,  Llama.  Lit  U  bi  any  nun  non-mgativi  dt finite  matrix.  Then  the  unbiased 
ulimaii  1  ,  which  is  a  linear  coabination  of  thk  measurement!  s  and  minimise*  the  quadratic  form 

l[  (i-x)rM(8  ~x)]  (8) 

is  again  given  by  Equation  (S). 

Suppose  this  proposition  were  false  and  let  i  =  Bs  ,  the  solution  with  a  matrix  B  different  from 
(HTR"1H)*lHTR"‘  ,  Without  restriction,  M  may  ba  assumed  to  be  symmetric,  for  (B>  is  a  homogeneous  quadratlo 
•fora.  It  it .has  multiple  eigenvalues,  it  may  be  submitted  to  the  Qauss-Bohmidt  orthogonalimatlon  procedure3  so 
that,  in  any  oase,  (8)  may  be  written 

,  (8) 

with  Qj  the  elgenveotor  oorresponslng  to  the  eigenvalue  \,  of  the  matrix  U  .  Note  that,  the  eigenvalues  \j 
are  all  real  and  non-negstive,  for  M  ia  a  non-negative  definite  rsal  symmetric  matrix.  On  the  other  band, 
alnoa  the  estimate  2  le  unbiased,  we  have 

BH  ■  1  ,  (10) 

with  I  the  Identity  aatrlx.  The  quedratlo  form'  (8)  le  therefore  equivalent  to 

jfc  hjqjRRB^  , 

which  mty  be  transformed  Into 

jfc  hjojBRB^j  *  jfc  ^flJ{HTR*‘H)_lqj  +  jfc  h.jQ][B-(HTirlH)*‘HV,]l»[B-(Htir1H)'1H1fR-l]IqJ  (li) 

In  view  of  Equation  (10)  and  the  identity 

B  ■  <HtR'  xH)  _ lHTll*  *  +  [B-(HVlH)"lHVl]  ,  (13) 

Blnoe  in  the  summation  (11)  aaob  tan  la  non-nesatlva,  we  art  left  with 

B  -  <Ht«',H)*,hV‘  .  (13) 

whloh  proves  the  lemma. 

A  direct  consequence  ot  the  lemra  la  that  the  estimate  Equation  (8)  has  tht  smallest  varianoe  for  aacb  of  its 
slaaenta,  aa  oan  ba  seen  by  ohooalng  all  aleatnta  ot  li  equal  to  zero,  except  for  t  unit  element  anywhere  on  the 
diagonal. 


8. 4  Theorem  3  (Recurelvc  Estimation) 


Suppoac  noma  partition  of  the  meaiurimenta  vactor  a  In  two  auhvoctor*  ak,t  ,  rk  ,  Partitioning  v  and  H 
accordingly,  Equation  (1)  may  be  written 


Vi  k  'W+Vi 

*k  B  «g*  +  vk 

and  wa  aeauta  tha  aat  vk.,  to  be  unoorrelatad  with  the  aat  vk  ,  an  that  R  haa  the  font 


(14) 


R  - 


0 

\  ' 


(15) 


Let  L.j  ind  Pk.t  be  the  minimum  variance  unbiased  estimate  and  ltd  associated  covariance  matrix,  defined  on 
the  subset  only.  Than  the  variance  un6ta»ed  estimate  defined  on  t/ia  eet  of  measurements 

«oy  be  obtained  ini  thou  t  reprocessing  the  subset  7.^  _  A  anti  is  given  6y 


*k  3  *k-l  +  V®k  “  Mk-t'  • 


(19) 


with  Kk  a  gain  aatrlx  defined  by 


h  ~  **k-iHf[HkPk.lHi[  +  Rk)  ,  (17) 

while  tha  cavarianoa  aatrii  Pk  la  obtained  by  . 

Pk  »  (I  -  KkHk)Vi  •  (i«> 

To  demonatrata  the  above  relatlona,  note  that,  in  view  of  Equation  (7),  tho  inveraa  covariance  matrix  ia 

pk‘  *  HTR"lH 

*  Hl.lRki,Hk.l  +  HgRg'Hg 

*  Pki,  +  HkRk lHk  .  (IB) 

Ihia  axpraialon  haa  a  olaaaloal  fora  in  aatrlx  algebra,  known  a«  the  ProUmiui  fora,  ao  that  tha  inveraa  nay 
be  readily  obtained! 

pk  3  Pk-i  -  Pk-lHktHkPk-iHf  +  «k)*Vk-i 

«  (I  -  RgHg)?,,.,  ,  (30) 

On  tha  other  hand,  In  view  of  Equation  (5),  tha  new  aatimata  9k  haa  tha  fora 

ig  =  l\HTR’la 

3  pkCHk-i*k!iVt  *  Hk"i‘»kl  ■  <»») 

Coablnatlon  of  Equationa  (30)  and  (31)  yialda  tho  reiult 

kg  »  (I-KgHk)Pk.,[Hj[.lRj;il«k.l  +  il{Rk,*k] 

■  (I  -kgVig.,  +  (I  -  RilHk)Pg.1HfR1;lak 
-  (I  ~  *kWi  +  Vi^a^i'*!  " 

-  ViHktHkViXk  +  *lfHkpk..Hk  +  '*hW\  + 

+  pk.lHk[HkPg-lHl+  \V\ 

3  *k-i  +  ltk<*k  -  Hkik-i)  .  <«> 

wbleh  coaplataa  tha  proof  of  tire  thaoraa, 

Tha  ganaralliatlon  to  ar,  arbitrary  number  of  aubaata  of  measurement!  \  unoorrelatad  with  each  other  ia 
obvioua, 
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2,5  Ihenrea  3  (Accumulative  Estimation) 

Hth  the  mm  definition*  an  above  for  ,  »k  ,  R^  .  ,  lkM  and  Pj.,  ,  let  us  now  denote  by  $k 

the  minimum  variance  unbiased  oetlaiato  defined  on  the  euhnot  ik  only,  end  let  Pk  be  the  corresponding 
coverlenoe  eetrli;  then,  (he  Minimum  parlance  unbttiied  estimate  (  defined  on  the  two  lubstts  (r.k.,.  v.k]  ii 
directly  oblulntd  by 

S  *  Pk'8kl  ,  (23) 

with  e  ooverlenoe  oitrlx  P  computed  from  the  relation 

p'1  =  pji,  +  pk‘  .  (24) 

The  proof  of  thle  theorem  It  t  direct  consequenae  of  Equations  (5)  end  (7):  In  feet,  we  have 

p-‘  = 

=  l{..  ,**!,*.,  + 

=  Pill  ♦  Pg'1  .  [25) 


end 


*  ■  PHtV1* 

*  *4.i1kWi  +  hJr;1*,,] 

*  Pt^iA-r  *  p;lik]  .  (2#> 

The  genehellietlon  to  en  erbitrery  number  of  subsets  of  Mesurements  unoorreleted  with  eeoh  other  le  egeln 
obvious, 

1.6  Observability 

Pro*  Equation  (7)  the  eilstenoa  condition  tor  a  minimum  variance  unbieied  cellmate  Is  readily  deduced:  the 
.unknown  state  vector  Is  obeervebie  If,  end  only  if,  the  matrix  H  haa  naituai  rank. 

1 7  Omenta 

Theorea  3  and  lta  dual  fora  (Theorem  3)  have  received  numerous  appltoatlone  In  the  field  of  satellite  orbit 
determination,  aapeclally  Refermce  4;  the  filtering  procedures  of  Bwerling1",  01au»s  end  Battln1'1  ere  dlreot 
donaequenoee  of  the*.  Theorem  2  lm  of  primary  Importance  In  modern  filtering  theory,  for  It  oonetitutes  the 
oorneritone  of  the  Kalman  raouralvo  filter. 

It  nan  ba  proved11  that,  far  noritl  prooeecie.  Unair  least  tquerea  eetlmatlun  yields  the  same  solution  as 
non-Unaar  least  squares  aetlaatlon.  Moreover,  In  that  cate,  the  lent  equartt  estimate  turre  out  to  be 
identlaal  to  the  maalmum  likelihood  eetlmete,  which  require!  to  waxlnlsw  the  conditional  probability  density  of 
meuurlng  a  ,  saturnine  x  , 

The  mlnlaum  variance  unbiased  estimate  It  often  called  Qauaaian  estimate,  Markov  estimate,  for  obvious 
rtaeoot  In  vise  of  Theorea  2  or  welghteo  least  aqutree  estimate,  undarllnlng  tha  ooourrauoo  of  the  oovarlanos 
aatrlx  R*1  In  the  quadrat lo  fora  (P). 

Let  ua  finally  emphaalma  that  the  alnlaum  varlanoe  unbiaied  estimate  requires  np  a  priori  lnforaatlon 
oonoerolng  tha  error  distribution  tunotlon. 


1.  TMC  KALIAN-RUCY  FILTERING  THEORY 
3.1  The  Kalman  Recursive  Filter 

It  will  bw  shown  In  tblw  section  that  tha  Kalman  flltar,  almost  simultaneously  darlvad  by  Kalman  and  Buoy', 
Battle1  and  Swirling 111  la  a  diraot  oonaaquanot  of  Theoreaa  1  and  2,  than  applied  to  first-order  discrete  linear 

•yatema. 

Consider  an  n-dlRenslonal  eon-conitant  atete  vector,  taking  the  value  at  at  time  tk  and  obeying  the 
following  first-order  dleorwte  linear  aquation  (1  a  1 . N): 


*1  *  ^i,i -1*1-1  +  *i-i  • 


(27) 


so 


where  iij.,  i>  t  *hit«  nole*  random  vector  sequence  with  mro  Min  tnd  poiltive  darinlte  eovarlince  matrix  Qj., 

*(»,.,)  -  0 

-  Qi-, 

■  SklQt  , 

•hilt  fj  j.j  li  th*  system  ititi  triniition  nutria  iron  tint  tA _|  to  tin  t4  .  At  noh  tint  tj  ,  the  itato 
vector  x|  ii  obtirved  thrnuih  the  measurement  equation 

«£  S  HjXj  +  Vj  ,  (28) 

with  thi  late  definitions  for  ij  ,  Hj  end  vj  is  in  Thoorin  2.  It  ii  furthir  issueid  thit  the  two  whiti  nolle 
random  isquencte  Vj  ind  wj.t  ire  uncorreUtid^ 

Then,  tbs  problem  say  he  formulated  in  fallows,  Find  from  the  meanurementa  (r.j.xj., . i,)  the  minimum 

vsrlince  unblueed  estimate  S(  (oovarlanor  matrix  Pt)  of  the  stitn  ,  dcpendini  linearly  on  the  measurements, 
assuming  tne  minimum  varlanoe  unbiased  estimate  (covariance  matt  lx  Pj . t >  to  be  known  from  the 

■eanurrmonte  («£..(,  »i.t . i(), 

In  order  to  apply  the  theorems  of  the  trsoseding  sections  to  ths  problem  at  hand,  1st  us  Introduce  the 
vectors  x1  ,  i*  ,  i1'1  ,  vl  defined  by  the  folloeinii  recurrence  relation*! 


X1  * 

$ 

* 

•  l  a 

N 

V1  • 

If  we  linlliriy  define  the  ■atrioes  S1'1  , 

, 

H1  ,  ,  Fl  , 

Q1"1  *  (((■‘-‘Kw1-1)’] 


n1  * 


the  whole  *et  of  Equetlonn  (27)  end  (28)  for  1  ruunlm  from  1  up  to  1  ,  ear  then  bn  (lobally  written 


I1  w  +  v1  , 

<3») 

or  equivalently 

■ 

a 

M 

+ 

• 

**• 

(30) 

with  #,  the  random  vector  variable 

e4  ■  -  rff1*1'1  +  V*  , 

(31) 

with  aero  at an  and  covariance  matrix  Oj  • 

Cj  »  H1r1«1*1(H1r1)T  +  *l  . 

(32) 

(iot»  that  liquation  (30)  ht«  the  form  of  Equation  (1)  an  that,  by  Tliaorem  1,  tha  aatlmata  xl.i  may  be  written 

i,.,  =  P1.l<ll1'l|t|l'l)TC1-!1*1'1  (33) 


P1.  ,  =  [  (Hl_  ,4|1  ■  1>T Cfi  J (H1  ‘  ‘■t1  -t)3  ■! 


In  vlaw  of  Equations  (5)  and  (7). 


Before  oaleulatlna  ,  lat  ua  flrat  compute  tha  minimum  variance  unblaaod  eatlaato  SJ  (covariance  matrix 
P()  of  tho  state  X|  ,  baaed  upon  the  measurements  (*i-i. *1-1 . *i)  only. 

Introduolnt  (37)  in  the  leneralimed  measurement  equation 

*l-‘  r  +  et.,  ,  (SB 


one  obtains 


el-i  =  +  e( 


where  e(  le  a  new  random  vector  variable: 

•I  -  •!-,  -H1-1'*1-1*,-,1!.!’!.,  ■  <37> 

with  aero  mean  and  aovarlanoe  matrix  0{  : 

Cj  »  Ct.i  +  H1'i,t‘‘l«ii1l.lQ1.t(Ill*1*l'1*[,l1.,)T  • 

Aa  a  Probenlua  form  la  rwooinlzad  in  tha  above  aquation,  (0[)‘l  la  known,  l.a. 

(Op-1  »  o{‘,  -  ci‘,Ml*,*i*,#ii,1.lt(*fji.1)Tfii1*i‘1.l  +  :sb) 

ao  that  the  oovarlanoe  aatrlx  f[  ,  which  may  be  written,  in  view  of  Theorem  1, 

(Pj)-1  =>  ,  (3B) 

reduaee  to 

<n>*‘  =  <*i.lt-i)T«*tii«r,‘i-a  (^SM)T^-,i*i.,i-iK«i.li..>T|,iii*i1,i-» + 

”  C*l,i-i*,l.i*{,l..  +  9l.il*‘  •  (40: 

u  own  be  eeilly  verified,  uelni  Equetlone  (34)  end  (38).  Thue,  P[  le  equal  to 

"  ♦l,l.»l’l.l*i.l.i  +  «l-i  •  W 

H  similar  manipulation  of  xj  ,  whloh  by  Thaorem  1  la  defined  to  He 

t{  w  pj(H‘-l<fl-‘{-j‘1.l)T(c;)-le1-‘  ,  (83 

leads  via  Pwatlona  (33),  (38),  (38)  and  (81)  to  tha  result 

*1  a  •  (43 

We  are  noe  In  puMtion  to  simply  darlva  tha  Kalman  filtar  aquation*,  for  all  th#  conditions  are  aatiaflad  to 
apply  Thaorem  3  with 


& 


*T  .  W  .  *">  -  rf-  l*'  I  w".  ¥*  .  I 


5} 

i 


;V«  ■  ■ 


*o  thit  tha  eatlmate  i4  la  lmmed lata ly  given  by  Equation*  (10),  (17)  and  (18): 

$!*»(  +  Kj(bj  -  HjJJ) 

Kj  «  P(Hl(H1P;ilI  +  Rj)'1 

P,  *  . 
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(44) 

(46) 

(16) 


Equation*  (41),  (43),  (44),  (46)  and  (46)  oonatitute  the  Kalman  flltar.  Tha  phyalcal  maanlm  of  thoaa 
aquatlona  la  avldant:  Equation*  (41)  and  (43)  extrapolate  tlu>  estimate  i,  .  from  time  t.  ,  to  time  tj  through 
the  atate  tranaltlon  equation  (37)  ahlla  Equation*  (44),  (46)  and  (46)  update  thla  extrapolated  estimate  on 
account  of  tha  new  available  meaauremanta  ij  , 


The  dynamical  ayatom  modal  (37)  may  be  readily  extended  to  Include  determlntatlc  forcing  terms 

*1  K  *i, 1-  i*i- 1  +  fl-i  4  «l-i  ■ 

Thla  clearly  affentH  tho  extrapolated  aatlmato  i[  only  and  Equation  (43)  muet  bo  replaoed  by 

*1  =  *1,1- i*l-i  +  fl-i  ■ 

the  other  filtering  aquatlona  remaining  unchanged. 


(47) 


(46) 


Tha  Kalman  filter  ia  capable  of  other  Important  extanalona:  although  out  of  the  acope  of  the  present  con¬ 
tribution  let  ua  quote  the  aiaiiltaneoue  estimation  of  lmpreoletly  known  parameter*,  entering  tha  dynamical  ayatam 
llnasrly11,  tha  replaoamant  of  white  nolle  aaqunnoaa  for  w.  t  ,  vt  by  wlda-aanie  Markov  aaquanoaa11  or  by 
■aqutnoea  oorralated  with  raapaot  to  aaoh  other10 .  atochaetic  optlmleetlon,  and  ao  on  ... 

3.3  The  Aorumulative  niter 

It  hat  been  ehown  in  the  preceding  eeotlon,  that  tha  Kalman  flltar  ia  a  dlreot  applloatlon  of  Theorem  3  to  flrat- 
ordar  diaorata  linear  ayatama;  it  la  tharafov*  natural  to  aek  whithar  Theorem  3  may  be  applied  to  tha  lama 
problam’1', 

Ocnaidar  Equation*  (37)  and  (36)  of  Baotion  3,1  with  tha  aim*  daflnltlona  and  aaaumptlona  and  lat  ua  introduoa 
a  o-dlmenalonal  vaetor  jl  auoh  that  .at  «ny  time  ■t1  the  following  relit lon  holdai 


Vi 


(48) 


It  la  eaally  verlfiad  from  Thaorams  1  and  3  that  auoh  a  vaetor  may  alwayi  be  defined,  furthermore,  euppuee  that 
tha  veotor  yj.j  and  tha  tnvarae  covariance  matrix  P{Jt  are  available  et  tine  t1#1  and  let  8i  bu  e  matrix 
defined  by 


■i  *  (*t,li-l>Tpi-i®:,li-i  ■ 

(60) 

Iquatlone  (40)  end  (41)  aty  then  be  written 

ri  *  ®il+«l-» 

(51) 

(Pj)'1  *  D(Bi  , 

(53) 

with  Dj  a  matrix  liven  by  the  relation 

Dt  *  I  -  BjCflj  +  Qfixl  ■ 

(53) 

Slallarly,  the  extrapolated  yt. 4  vector,  l,e.  y[  ,  nan  be  written 

»!’  *  Di<*l,*t-x>T ^l-x  • 

(64) 

In  vie*  of  Equation  (43), 

Uea  of  Theorem  3  yielda  the  new  veotor  yt  at  time  tj  , 

yt  e  y{  +  , 

(58) 

and  th*  lnvarae  eetlmate  oovarlanoa  matrix 

Pi1  *  (p{)*‘  +  hJrj'h^  . 

(56) 

1  A  A  .  ■  A  A  ,  * - 
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Tho  aatimat#  it  19  then  availsblo  vu 


-  Vi  .  (Si) 

Equation)  (80),  (02),  (S3),  (84),  (69)  >1111  (80)  constitute  the  aeoumulstlve  filter  equations  for  the  i>i-4>blem 
*t  hand.  It  In  Important,  to  note  ttmt  tho  calculation  of  the  estimate  ^  la  made  Independently  of  tho 
accumulative  filter:  It  manna  that  »ny  error  In  tho  Inversion  of  PJ1  dooa  not  affect  the  succeeding  entimntee, 
For  tho  lenenl  onao,  however,  the  accumulative  filter  la  not  a  practical  tool  to  nolve  the  problem,  In  view  of 
the  n  «  n  matrix  Inversion  required  In  Equation  (S3).  Tho  situation  is  completely  different  In  the  ahsnnoe  of 
plant  noise;  In  such  cenes  (*t.l  =  0  for  any  1).  the  Hj  matrix  reduces  to  the  Identity  matrix  10  (hat  the 
acoumulatlvu  filter  equations  simply  become 


«1 

= 

(80) 

(P[)-1 

s 

«i 

(82) 

“i 

I 

(83) 

y[ 

T 

(+t.,i.i>T»i-i 

(84) 

h 

■ 

+ 

(88) 

a 

(pO*1  +  iiinrlHi  • 

(80) 

Any  numerical  matrix  Inversion  hue  completely  disappeared  In  the  schema,  which  la  not  the  oaae  in  the  Kalman 
fllteri  the  oomputetlon  procedure  la  made  particularly  1 tab  In  and  thla  may  bt  of  primary  Importance  when  weakly 
obaervable  ays  tens  are  dealt  with, 

3.3  Observability  Condi tlnn 

In  vlaw  of  Theorem  1  and  Equation  (29),  an  observability  condition  la  sully  obtained:  the  »t,Uo  x,  Is 
obssrvabls  if,  and  only  if,  tha  matrix  (H1^)  rCj'(Hlltl)  has  an  Invent  or,  more  compactly,  if  and  only  if  the 
matrix  H‘411  has  a  *enorali*ed  Invarae  (.C4  la  poaltlva  definite), 


4.  CONCLUSION 

The  sodern  rsourslva  fllterlnc  theory  has  been  ahown  to  pro. eeu  from  an  Idea  orlilnally  due  to  Gauss,  at  least 
In  esatnae.  Hors  prtolstly.  simple  theorems  srlslm  from  the  minimum  vsrlsnoe  eetlmatlon  of  s  ooneliuii  state, 
linearly  dtpendlns  on  the  measurements,  hays  bean  applied  to  discrete  first-order  etoohutic  linear  i-ysnas,  by 
the  way  of  a  raatatamant  of  the  problem.  Aa  a  raiult,  the  Kalman  filter  and  its  dual  fora  hava  baai,  chained  by 
alaple  aliebrato  manipulation*, 
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CHAPTER  3  -  COMPUTATIONAL  TECHNIQUES  IN  KALMAN  FILTERING 
Stanley  F.  Schmidt 


I.  INTRODUCTION 

In  tho  application  of  Kalman  filtering  theory,  tho  Latheaatlcal  formulation  of  the  problem  and  computational 
techniques  utilized  may  depend  hon-  ily  on  the  computational  capabilities  available,  Tills  interface  is  particularly 
strong  in  mat  time  acroapacc  applications  shorein  considerations  of  anight,  power,  and  reliability  gunorully 
require  tho  selection  of  techniques  which  minimize  onboard  computational  requirements. 

The  discussion  of  this  chapter  will  emphasize  computing  techniques  for  Kalman  filtering  in  these  onboard  type 
problems.  The  techniques  are  applicable  but  not  necessarily  essential  when  large  general  purpose  computing 
facilities  are  available. 

A  note  lu  p  using  is  that  the  Kalman  filter  la  s  apodal  data  processing  technique.  It  was  originally 
lntroduood1, 1  for  the  onboard  application  because  of  Its  reduction  in  computational  requiremuntn  over  othsr  methods 
svs liable  at  the  tlae. 

Numerous  Investigators1' '  have  reportad  various  problems  with  tnd  “fixes"  for  Kalman  filters.  The  problems  In 
general  fall  Into  the  following  categories: 

fa)  Loss  of  positive  definiteness  in  the  covariance  matrix  resulting  from  numerical  errors. 

(b)  Improper  mathematical  model,  leading  to  a  divergence  of  the  estlm"*-,  from  tuasufementa. 

(o)  Nonlinear  phenomena  generally  aggravated  by  a  poor  selection  of  the  starting  estimate. 

Of  Lhasa  problem*,  (a)  tea  probably  been  experienced  .to  somo  degree  by  .almost  evaryone  working  ill  the  field. 
Reasonably  afflelent  (from  computational  considerations  solutions  iol  this  problem  based  on  square  root  algorithms 
will  be  given  in  this  chapter. 

For  Item  <b> .  techniques  exist  for  oompeniat ing  for  error*  in  the  mathematical  m„ujl.  The  techniques,  although 
useful,  still  leave  a  good  deal  of  "cut  and  try"  In  finding  siiitablo  solutions.  Some  relevsnt  material  on  this 
subject  will  be  oovered  In  th.'a  chapter. 

Item  (o)  will  not  be  covered  hire,  me  mechanization  aquations  described  use  linearization  about  the  ourrent 
beat  aatlmate  of  atata.  This  tailor  and  tho  occasional  requirement  of  specially  designed  starting  calculations 
(breed  on  the  raw  data)  heve  removed  nonlinear  problems  in  the  practical  applications  with  which  the  author  is 
familiar. 


2.  MATHEMATICAL  FORMULATION  AND  DEFINITIONS 

One  of  the  first  problems  which  must  be  addressed  in  applying  Kalman  filtering  theory  is  the  mathematical 
formulation,  of  the  problem.  This  section  will  define  the  overall  filtering  problem  from  a  practical  viewpoint. 

2.1  Froblea  Statement  and  Dlacuitlon 

(1)  A  true  eet  of  dynamical  equations  describing  the  dynamic  behavior  of  the  system  is  believed  to  be  re¬ 
presented  by  a  set  of  vector  differential  equations 

X  =  F(X,C,U,t)  .  (2.1) 

One  therefore  develop!  a  set  of  equations  tor  the  system  of  the  form 

X  =  F(X,C,U,t>  .  (2,2) 

where 

X  a  t  vector  describing  the  fundamental  state  variables 
Cot  vectcr  describing  constants  used  In  the  system  equations 
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'  U  =  a  vector  of  forcing  functions  acting  on  thn  dynamic  system 
t  =  tha  independent  variable,  time. 


(11)  A  vootor,  Y  ,  of  meanuremonts  is  available  which  In  hollovod  related  to  the  fuudiunontol  state  variables 
In  the  form 


Y  =  od.V.T)  +  q(t ) 

A  model  of  these  moasuremonts  la  therefore  developed  of  the  form 


(2  3) 


where 

V 

<1 


Y  =  0(X, V, t)  +  q(t)  , 

a  veotor  describing  assumed  aonstants  and/or  time-varying  states  in  the  mcanureuont  model 
the  assumed  random  error  In  the  measurement. 


(2.4) 


Before  proceeding  furthor  in  the  definitions  aomu  discussion  of  the  notation  and  meaning  of  tho  phrases  "kolievod 
to  he”  and  ''assumed  to  be"  ia  In  order. 


“Believed  to  bo"  Is  doflned  as  meaning:  In  conformance  with  such  scientific  knowledge  an  is  possessed  at  tho 
preaont  time. 

"Assumed  to  be"  ia  used  in  the  context  of  known  approximation,  such  as  truncations  of  infinite  aorios  represents' 
tiona,  and  so  on. 


(ill)  An  initial  estimate  of  the  stute  veotor  at  a  time  tg  nay  be  given,  or  is  aaaumed,  as 


X(t0)  =  X„  ,  <2.  ft) 

(lv)  Other  initial  oonditiona  and  tine-varying  forcing  functions  which  are  assumed  are* 

O(t0)  =  C„  (2.6) 

V(t„)  =  V8  (2.1) 

U0(t)  =  U0  .  (2.B) 

(v)  Tha  .arrera  in  the,  .pmlously.  do  fined  quantities  are  definod  by 

S(X0-X0)  =  E<x„)  *  0  (2.B) 

B(S0S„)  =  covariance  matrix  =  P0  (2, 10) 

E[«(t)]  s  0  (2,11) 

E(q«T)  “  Q(t)  (2.12) 

E(C-Cp)  =  3(8,)  =  0  (2.13) 

E(8,8j)  =  P0o  (2.14) 

E[U(t)  -  Gc(t)]  =  E TO (t )  1  =  0  (2.  IB) 

E(0a)T  =  PUo(t)  (2.  16) 

E(V-V),  =  E<7)  =  0  (2.17) 

E(WT)  =  Pr„  (2.18) 


Tha  use  of  the  expected  value  operator  E  In  Equations  (2,9)  to  (2. IS)  requires^soae  discussion.  Nominal 
usage  of  the  operator  implies  an  ensemble  average.  For  example,  if  the  errors  in  X  are  considered  as  injection 
errori  of  a  apace  vehicle,  the  ensemble  represents  en  infinite  number  of  launoh  vehicles  of  the  same  type  launched 
from  the  tame  location.  If  the  basio  causes  of  injection  errors  are  random  in  this  ensemble  and  It  Is  meaningful 
tor  the  problem,  then  (2.9)  is  a  true  statement. 

In  genertl  one  cannot  define  a  meaningful  ensemble  for  quantities  such  u  errors  in  the  estinate  of  the  vectors 
like  C  and  V  .  Hence  one  reelly  should  oonsider  the  initial  values  as  estimates  and  the  covariance  matrix  as 
a  confidence  level.  This  le,  in  fact-,  how  one  uses  the  quantities  and  the  problem  of  defining  the  ensemble  is 
avoided.  Equations  (2.3),  (2.7)  end  probably  (2.15)  are  aot  true  statements  In  the  striot  statistical  senae. 


As  a  result  of  Halted  knowledge  and  known  spproxlaatloh  In  coeiputatlone,  one  uy  desire  to  consider  a  portion  of  U(t)  to 
be  a  r endow  forcing  function.  Thin  will  be  dlaoueied  later  in  thie  chapter  aa  a  possible  weans  of  dynewlo  nodal  cosmensatlon. 


SB 


>.3  Probluw  Objective* 

{ 

Th«  objective  o f  filtering  lor  data  processing)  considered  heroin  1»  to  find:  " 

Algorithm*  fur  use  In  a  given  computer  which  process  the  monauroment  data  and  provide  an  iitinatt  of 
the  state  variables  which  it  sufficiently  accurate  for  real  time  command  and  control  purposes. 

Additional  factors  which  must  Iw  conaldored  in  this  problem  llicludo: 

(a)  Computer  apoed, 

(b)  Computer  memory  availability. 

(o)  Computational  arrora. 

(d)  Measurement  data  availability. 

(o)  Development  time  aobedulo. 

Thla  problem  statement  containa  acne  of  thn  pruotloal  considerations  which  arlae  in  moat  applloatluna  of 
Kalman  filtering.  Theory  1*  uaod  to  provide  appruuchos  f or  finding  a  praotical  aolution.  By  no  meana  will  thla 
solution  bo  optimal  in  the  theoretical  aonao.  Thla  in  bscauae  exact  mathematical  mode  la  of  all  quantities,  as 
well  as  practical  performance  indices  which  consider  all  the  factors,  cannot  be  doflnt'd. 

Subsequent  diacuaeion  will  assume  that  preliminary  considerations  of  computer  speed  and  memory  have  led  to  the 
requirement  of  data  processing  algorithms  of  a  "one  pass"  nature.  That  la,  ones  moceuremonta  at  any  time  point 
have  been  processed  they  muat  he  discarded.  This  aiaumption  is  made  to  restrict  the  soaps  of  subsequent  dlaaussloo 
to  eodlfiad  forms  of  the  Kalman  filter. 

A  practical  solution  of  the  filtering  problem  In  any  specific  example  la  found  by  tbe  use  of  existing  theory 
and  praotloal  experience  to  defliii  starting  algorithms.  Simulation  is  then  uosd  for  further  validation  and/or 
■odifioatlous.  Final  validation  and/or  modifications  then  take*  place  in  teat*  of  the  real  system. 

Before  introducing  the  basic  algorithms,  aoms  additional  definitions  are  required.  If  the  gradient  of  (2.2) 
is  taken  with  respect  to  X  .  C  ,  end  U  ,  a  act  of  tlmo-varying  linnar  differential  equations  is  obtained*: 

i  =  P(t)x(t)  +  B(t)o  D(t)  u(t)  ,  (2.18) 

there 

KO  *  V(X.C.U,t)jx(t)  .  i(t) 

Bit)  *  Verac.U,t,|0{t)  .  6(t) 

D(t)  *  7/<X.C.U.t>|,,(t)  =  0;t)  . 

Since  (2. ID)  is  linear,  the  general  solution  may  be  written  in  tbe  form 

X(t)  =  $(t:t,)x(t0)  +4<!(tit,)o  +  ♦(t;r)D(r)u(T)  dr  ,  (2.20) 

The  transition  matrix  $(t;t,)  and  the  eenaitivity  to  constant  foroea  or  control  oen  be  found  by  solving 
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&  =  F(t)$  . 


*<t0;t0>  =  i 


Z  =  10  -  constant  terms  in  aquations  of  motion 

\  0./  -  constant  force*. 


In  this  instance  the  augmented  state  deviation  obeys 


l(t)  =  4s(t;t0)s(ts)  +  f*  4,(t:T)D<T)u0<T)  dr 

•tn 


if  linear  aamioptiona  are  valid. 


*  Loetr  cant  Utters  ero  used  to  denote  imII  deviation*  froa  the  carreapoudinf  upper  oue  value,  That  is.  a  vector  Z  ia 
oojeldered  u  Z  =  Z  *  z  . 


*0  a  •*(*>*«  +  B(t)(I)  .  *0(t0it()  =  0.  (2.22) 

The  integral  term  of  (2.20)  may  be  solved  by  approximating  u(t)  as  a  oonatant  for  small  time  increment*,  A: 

»  F(t)*„  +  D(t)I  ,  *u(tg+uA;  t,tnA)  =  0.  (2.23) 

It  la  usually  convenient  to  aonslder  an  augmented  state  rector  of  the  form 

/x\  -  fundamental  state  variable* 


u  m»  »*'*'•*  *  **  *  > 
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The  gradient  of  the  measurement  equation  (2.  4), 
(or  tbe  1th  eaaauromfnt  • 


1*  taken  with  rospoct  to  X  and  V  to  find  1  inoar  equations 
htl  +  gsV  +  q,  ,  (2.  28) 


where 

h4  =  Vx0(X.V.t1)||(t)  -  j(t> 


(2.  26) 


«1  =  VvOtX.V.t^lv.,  . 


(2.  21) 


Ono  nay  desire  to  relate  the  vector  of  monsuremente  to  tho  vootor,  zB  ,  st  a  fixed  epoch.  Thin  nay  bo  done  by 
using  (2. 24)t  and  (7.28)  to  obtain 

y  =  Hza  +  Ov  +  q  .  (2.  2B) 

In  (2.28)  the  vootor  y  may  consist  of  measurements  at  different  tlmu  points.  Tbe  vector  z0  cin  bo  at  a 
fixed  epoch.  This  faot  can  be  used  to  obtain  an  algorithm  for  processing  email  batches  of  data  or  for  a  simplified 
form  of  data  compression 10.  It  la  generally  desirable  to  consider  a  further  augmentation  of  tho  stnte  to  lnoludo 

the  measurement  parameters,  V  .  Then  (2. 28)  would  be  written  In  the  equivalent  form 

y  =  (86)^  +  1  £  Bi0  H.  (2.  29) 

In  tbe  case  where  it  is  meaningful  or  nceeseary,  ono  may  write  the  equation  for  updating  tho  covariance  matrix 
P,(t)  in  tins 

P,(t)  *  VtStylW*g<tito>  +  R  •  (2.  30) 

The  matrix  R  in  (2.30)  gives  the  added  uncertainty  caused  by  random  foroing  functions  In  the  time  Interval  t  -  ta 


2.3  Kalman  filter  Equations 

A  Modified  form  of  the  Kalman  filter  for  nonlinear  ayatema  is  given  here  for  processing  the  measurements  in  a 
sequent  ill  •manner,  These  algorithms  are  readily  derivable  from  Kalman’s  original  equations  for  the  discrete 
filter*.  The  algorithm  ie  conveniently  elatnd  in  two  parts: 

(1)  Between  the  1  and  1+1  measurement  times, 

£{tui)  r  Zftp  +  /**♦*  t(T)  dr  (2.31) 

ll 

*,  ■*  *.  •  *,<tiStt)  =  I.  (3.32) 

(U)  At  maaauremsnt  times  tJ+,  , 

p*(tltl)  =  Vi«l>*5  +  *  =  Pb  <2.33) 

Z*  =  Zb+K(T-i)  (3.34) 

P*  =  Pb  -  KHP„  (2.38) 

K  =  PbHT(HPbHT  +  Q>'1  (2.36) 

Y  =  0(X,V,tul)  a  computed  measurement. 


Equation.  (2.31)  is  a  simple  statement  of  Integrate  '.he  ayetem  dynamic  equations  (2.2).  The  Z  notation  is 
used  to  imply  a  tine  update  of  all  those  components  of  the  state  which  are  assumed,  non- constant  The  transition 
matrix  can  bo  calculated  by  integrating  tbe  variational  equations  implied  in  (2.32)  with  the  apiropriate  initial 
ooudltiona.  At  the  measurement,  time  t.  ,  .  the  covariance  matrix  Pz(t,kl)  ia  calculated  by  .2.33).  Equations 
(2.34),  (2,38),  and  (2.36)  art  then  used  to  saloulste  the  new  estimate  of  state,  2(  .  and  the  n«w  -nvarlanoe  matrix 
Pt  .  These  new  values  result  from  including  the  measurements  Y  at  tins  tlM  in  both  the  eit*  .*  and  the 
oovarlanoe  matrix. 

Note  that  If  the  Influence  of  random  foroing  functions  is  approximated  by  the  use  of  (2.23),  then  (2.33)  abould 
be  updated  at  A  time  intervale  between  tba  measurement*. 


*  The  random  error  ia  aeaauremeat  la  assumed  to  be  smll  and  therefore  eoasidered  to  live  a  email  jandoe  deviation  from  a 

aoleeleas  meaaureaent. 

1  The  effect*  of  tbe  rendoe  variation  of  u(t)  are  eeauntd  oegllslble  la  writing  this  expreeslop.  Otherwlee,  s  time  correlated 
error  eust  be  added  to  equation  (2.29) 
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3.  S QUARK  ROOT  FORMULATIONS 

A]  tlready  mentioned,  numerical  errors  frequently  cauno  a  problem  when  the  covariance  matrix  equations  (2,  32) 
and  (2.35)  are  used.  The  uaual  symptom!,  of  the  problem  are  negative  diagonal  terms  cocuring  In  the  covariance 
matrix  after  processing  data.  The  problem  can  oocur  after  the  flrit  measurement  in  same  Instances13.  It  is  more 
of  a  "nuisance"  than  of  a  aerlous  typo,  as  one  usually  van  find  a  remedy  by  adding  or  Increasing  R  of  (2.33). 
This  la  one  of  the  techniques  discussed  in  Section  4  for  model  error  compensation.  The  other  toohnique  given  In 
Section  4  also  can  be  used  as  a  remedy  for  this  numerical  problem. 

This  numerical  difficulty  can  also  bo  romeved  by  squnro  root  mothoda.  The  square  root  methods  also  provide  a 
significant  Improvement  In  numerical  accuracy  of  the  covariance  matrix.  Since  the  covsrlanco  matrix  is  the 
eaithtlng  factor  containing  the  effects  of  all  past  measurements,  improving  the  aocuraoy  of  this  matrix  car,  be 
important  to  some  problems. 

The  square  root  of  P  Is  defined  an  V  and  satisfies  the  relationship 

*»T  =  P  r  wlfT  .  (3. 1) 


where 

wt  a  1th  column  veotor  of  the  matrix  I 

n  =  th*  cumber  of  columns  of  W  ,  which  will  be  defined  as  the  dimension  of  P  . 

With  this  definition,  if  P  is  positive  definite,  the  column  vectors  w,  are  linearly  Independent.  It  is 
genorslly  desirable  to  force  the  oolumn  vectors  of  I  to  bo  linearly  independent.  Then  when  P  It  positive 
semi-definite  some  column  vector  or  vectors  will  be  null.  The  rank  of  F  la  equal  to  the  number  of  non-zero 
column  veotovn  of  W  In  thle  formulation, 

In  the  caee  of  the  equare  root  matrix  one  neada  computation  algorithms  for 

(a)  starting  the  problem  (e.g.,  given  P0  find  W0) , 

(b)  propagating  *  in  time  (aquara  root  of  (2.33)), 

(o)  modifying  W  for  including  measurements  (square  root  of  (2.35)). 

Bubse quant  material  will  summarize  algorithm  for  theae  purpose!, 


3.1  Initialization  ef  the  Sqgiare  Root  Matrix 

One  obvloue  way  of  specifying  the  initltl  square  root  matrix  W„  la  to  doflne  the  oolumn  veotora  of  »0  .  One 
should  nnta  that  whan  the  ooluans  of  Wa  are  made  linearly  independant,  caoh  column  specifies  an  independent 
error  eouroe.  All  error  sources  lie  In  different  directions  in  tbs  state  space. 


An  alternate  problem  la'that  P„  Is  gives  tnd  a  auitable  aquara  root  matrix  Wa  la  to  be  defined.  For  thla 
usage  and  from  the  preceding  dlsousaioo  it  is  seen  that  the  desired  algorithm  will  construct  a  set  of  column 
veotora  of  the  matrix  w0  which  ara  linearly  Independent.  Consider  the  application  of  tha  following  equation 
for  Bt  a  F#-. 


Dk*i 


= 


8kVkBk 


vkVk 


(3.3) 


In  (3.2)  vk  la  an  arbitrary  (non-zaro)  column  vector.  Note  that  the  quantity  vkBktlvk  ia  zero.  In  other 
sords,  (3.2)  removws  ell  errors  of  P0  in  the  direction  of  the  veotor  vk  .  If  vk  is  chosen  such  that  its  kth 
element  le  unity  and  the  remaining  'elements  ara  sero,  the  kth  row  and  column  from  '  8k  are  removed.  By  letting 
k  =  1 . n.  then  Bfl+l  =  0  .  The  quantity  n  la  the  dimenalon  of  P0  (the  number  of  stats  variables). 


Therefore,  by  defining  the  oolumn  vectors 

of 

w0  by 

BkVk 

|  0 

vjB„vk  t  0 

■k  3. 

v'<VkBkVk) 

II 

0 

if 

»kVk  =  0 

v  > 


the  resulting  »0  matrix  will  be  of  lower  triangular  form.  From  filtering  considerations  one  car,  viaw  the 
algorithm  as  the  equivalent  of  making  n  perfect  observations  of  the  state  vector  wbioh  reduce  the  error  in  ell 
components  to  sero  (B0M  «0).  The  error  vector  removed  after  escb  step  of  the  algorithm  isitored  so  that  tha 
astrls  P0  oan  he  recovered  from  Wa  .  Thle  algorithm  ia  giveu  In  a  slightly  different  form  in  Reference  11. 


nil  iliorltba  la  (ivin  In  Rafaranca  13  ud  all!  ba  rafarrad  to  u  Pottar'a  aathod, 


3.3  TIM  Update  Of  the  Square  Root  Matrix 

Two  Mthodl  U> r  updating  tho  (quart  root  matrix  In  tlmo  for  random  forcing  function*  art  given.  Both  itnuma 
that  the  matrix  R  of  Equation  (3.33)  la  avallabla  In  faotortd  form  anch  that 


■  ■ 


Xj  art  linearly  independent  rector* 

J  *  number  of  random  forcing  function*. 

J.J.i  Mi t hod  So.  1 

A  (quart  root  matrix  time  update  algorithm  can  be  developed  by  noting  that 


p-'(t)  =  (bpif1  +  ^  *ksjj 


Am  *  raeult  of  the  wall-known  matrix  indent ity 

[8  +  tt*]‘‘  s  8"‘  -  B'‘t(tV‘t  +  l)'ltTB‘‘  ,  (3.14 

and  Potter' a  aquar*  root  method  for  aquatlona  Ilka  tha  right-hand  aide  of  (3. 14),  out  method  for  obtaining  the 
time  update  of  the  equare  root  matrix  la  readily  developed.  The  atepa  are  ae  folio**: 

(1)  Define  00  B  [**(t0)]‘l. 

(11)  Operate  J  timea  on  the  matrix  0  ,  using  Equation  (3. 11)  with  H  s  lt  ,  1  »  1  ,  J  and  Q  =  1. 

Let  the  reault  be  Qj  . 


(ill)  Then 


»(t)  =  a]1 


Examination  of  Equation  (3.3)  Uluatratea  that  it  may  be  factored  a*  followa 

*k*i*k*i  a  Mk*k*I**k  a  Bk*i  ’ 


"l  .  Ak<Akvkvk>~ 
_  ykAkAkrk  _ 


Hanot,  if  tha  matrix  A  la  raduoad  ualng 


*k.i  a  Mk 


and  tha  «  matrix  of  Equation  (3.3)  la  atored,  a  lowar  triangular  matrix  in  R  will  raault.  furthermore,  tbla 
lower  triangular'  matrix  hae  the  property  that 


tr  =  A, AT  ■ 


It  ebauld  therefore  be  obvioua  that,  if 


Ciw  I  si  , 


the  raaultiag  aquaro  root  matrix  W  li  th*  dcairid  aquara  root  matrix  wbioh  inolud#*  the  affect*  of  the  random 
forcing  funotloni.  Thla  method  woa  davalcpad  by  che  author11  but  appaara  to  bt  equivalant  in  practice  to  the 
taohuiqua  outllnad  in  Rafaranc*  14, 

Th*  apecial  ohoioa  of  vestor*  (tbt  kth  alament  unity  and  all  othar  alementa  zero)  sakaa  tha  matrix  Mk  vary 
almpla  to  caloulata,  Furtharmora,  iu  (3.17)  each  atap  of  th*  algorithm  mokaa  the  kth  row  of  tha  matrix  Ak<1 
aero.  Aa  a  reault  tha  number  of  operatiomi  ia  not  aa  large  at  it  may  appear  at  flrat  glance. 


*VY.  V 


r&ipnw 

,Y*./v  “a\V 
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Tha  author  ia  aot  attar*  of  any  axtanalva  uae  of  thla  taohniqua,  aa  a  raault  of  tha  obvioua  drawbaok  of  raquiring 
two  matrix  invwroiona  Ter  ovary  time  update.  Rafaranoa  14  rafara  to  thla  technique  ae  Potter' e  method. 

3.1  2  MithodNo.U 

An  alternate  technique  which  doee  not  require  lnrereion  can  be  davalopad  in  a  relatively  almpla  aanner  from 
the  material  preeented  thue  far. 
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I  ✓a,  5  I  s  itoond  column  of  *(t) 
\  1,  B/v/2.  P/ 


A,  a  0 


third  column  of  W(t) 


Tha  final  anayer  la 


/a//a 

W(t>  a  I  lA/J 

ViA'a 


(3,  22) 


A*  a  ohaok  ona  may  oomputa  A/,  from  Count  Ian  (3.31)  and  compart  the  raault  to  »(t)»T(t)  of  Equation  (3.32). 
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An  notad  from  tha  axaapla,  tha  following  two  faota.  about  tha  mat  hod  ara  ilmlf  leant; 

(1)  Tha  dlnanaloo  of  My  and  Ak  raduoaa  (affactivaly)  by  ona  at  aach  atap. 

(11)  Tho  final  aolutlon  for  W(t)  la  a  lotfar  triangular  matrix,  that  la,  tha  alamanta  above  tha  diagonal 
of  >(t)  ara  aaro.  Thla  faot  can  ba  uaad  to  raduca  tha  nunibar  of  oaloulatlona  for  tha  aeaauramant  update  for  tha 
tlrat  naaauraaiaot  prooaaaad  aftar  tha  time  updata  algorithm. 

loth  thaaa  faota  raault  from  tha  apaoiflo  ohoice  of  tha  vt  vaotora. 

3-4  Reooaaaandad  Algcrlthaa  for  S«i*ra  hoot  Implanantationa 

Tine  Updatt  Equation*  to  a  Keojurement 

Ut  Al  =  (4>TF  •  8).  (3.33) 


ass 


>>.■»>>>; 


Calculate  tho  ooluoai  veotora  of  W(t)  in  accordance  with  the  n-ecop  algorithm  k  -  1 . n  whero  v h ( i )  -  0  , 

1  A  K  ,  and  vk(k)  “  1  . 

11  A^A^Vjj  (3, 34) 
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Akti  e  MkA|, 

wk  S  »k//{»k(k>)  »  kth  column  of  W(t) 


Meaeurement  Update  (for  a  Single  Measurement) 
Co*put»  th*  victors 


Modify  «  in  accordance  with 


I  r  y  -  uvT/a  .  (3,31) 

3,3  Comparative  Computation  Requlremente 

Although  tha  propoaed  method  ahould  anhanoe  the  accuracy  It  may  be  ooetlj  In  machlna  time.  The  propoaed  method 
la  compared  hare  with  the  more  conventional  method  ualng  the  covariance  matrix  (Equatione  (2.33),  (2. 39)  and  (2.30). 

The  comparlaon  data  liven  aaaume  that  nona  of  the  metrical  or  vaotore  have  meroe  In  preeorlbad  looatlona.  Alec 
P  la  aeaumed  an  n»n  matrix  and  S  an  u«a  matrix. 

Afuaber  of  Optratiani  for  a  Timt  Updatt 
(i)  Conventional  Method** 


MAD  A  AS 

Equation  (2.33) 

2a1  +  n'a  2n*  +■  n’a  +  n* 

I  te.1’  \  “  e  t  »  <  ■ 
Je  t  >  «  * 


(ii)  Square  Root  Hat  hod 


A*  on  ertmple  tHkUnu  that  n  ~  10  and  s  =  1  ,  Tho  use  of  the  tabulated  aquation*  for  Dunbar  of  operation* 
lira*  tha  following 
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Equivuhnt  USD 

MSI) 

A  SS 

•Scjuar*  Hoot « 

Conventional  Method 

3550 

3100 

3300 

0 

Square  Root 

5837 

4830 

4786 

10 

Tha  aolumn  labeled  "Equivalent  M  t  l)"  assume* 

(1)  Square  roots  take  6  tinea  a*  lone  as  Multiplications. 

(li)  Addition*  take  1/5  of  tbo  time  of  nultlplloatlotm. 

For  this  example,  the  square  root  method  takes  twlon  as  much  computer  tine  as  the  conventional  method.  If  the 
advantage  of  symmetry  of  the  covariation  matrix  for  tho  conventional  nethod  was  forced,  then  it  would  be  about  3 
tines  as  feat  as  the  modified  square  root  method. 


Member  of  Oporationi  for  a  Uouiuromint  Vpd at*  /.Scalar  Observation^ 
(i)  Conventional  Hot  hod 


MSD  ASS 

Equations  (3.35)  and  (3.38) 

3n*  +  n  3n*  +  n  +  1 

(11)  Squart  Root  Vet hod 


If  Triangular  On  Start 

Not  Triangular 

USD 

ASS 

USD 

A  SS 

Equation  (3.38) 

S’*1-1 

£n  +  l-i 

n‘ 

n* 

Equation  (3.30) 

£n  +  l-l 

S,,i-1 

n1 

n* 

Equation  (3. 30) 

n  +  3 

3 

n  +  3 

3 

Equation  (3. 31) 

n*  +  n 

n* 

n’  +  n 

n* 

One  square  root  is  required  in  Equation  (3.30). 

The  number  of  operations  in  ths  various  oolunns  indicate  whether  or  not  I  is  triangular  after  a  time  update. 
Thle  advantage  can  only  be  uaed  for  the  flret  sieaeureaent  prooeieed  it  a  given  time  point. 

for  oonparativa  data  aeium*  that  n  =  10  and  a  aingle  measurenent  is  prooeaied. 


equivalent  USD 

USD 

ASS 

•Srfuar*  /foot 

Conventional 

383 

310 

311 

0 

Square  root 

387 

333 

303 

1 

Square  root  (trlansular) 

387 

333 

313 

1 

The  "Equivalent  M  k  D"  aolumn  la  ooaputed  using  the  asm*  raiatlonahip*  a*  stated  for  the  previous  ossa.  The 
•quart  root  method  hae  a  alight  advantage  tor  the  flret  meteuresent  proaessed  if  W  is  trlingular.  However, 
thli  advantage  i*  loit  for  lubiaquant  leaauresante. 


*.«  -  V 

VAV' 

I". 
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If  out  takes  sdventnte  of  symmetry  for  tlio  conventional  method  iml  other  obvious  improvements  In  technique* 

(for  example  forming  the  vector  PII17(I0,IIT  +  Q)  lnutimd  of  dividing  n1  times),  then  tho  convent 1  on»l  isothod  mill 
be  shout  twlos  st  fsst  for  the  example  cltsd. 


J.S.i  Influtnci  of  Coding  T'ec/vilqusi 

Coding  can  llgnlflostitly  slttr  the  previous  computational  time  estimates.  Tor  sxsmplt,  If  the  square  root 
method  sirs  codnd  ss 


sad  tho  conventions!  method  ss 


■hers 


=  'll"— | 


P„  =  [i-kh][pHi-kh]t  +  k«t 


1’IIt(I1VHt  +«)'1 


(3.32) 


(3.33) 


then  the  oumpsrleon  Is  ss  follows  for  n  single  measurement.  No  sdvmitsge  of  W  bolng  trlsngulsr  Is  used. 


M  St  D 

A  SS 

Square  (loot 

Conventions! 

2n’  +  3n*  +  3n 

2n*  +  an,1  +  2n  +  1 

0 

(n  s  10) 

2330 

2221 

0 

Square  root 

n*  +  2n*  +  m  +  1 

n1  +  n*  +  2n  +  1 

1 

(n  *  10) 

1211 

1122 

1 

Bavvral  oonoluslons  srs  svldent: 

(1)  One  should  uot  ends  the  squsre  rout  slgorlthm  using  Equation  (3.33)  If  speed  of  ooiaputstion*  Is  of  sny 
lmportsnos,  Thtrs  ire  no  obvious  sdvsntsges  of  (3.32)  for  sooursoy  tlther,  to  It  Is  deflultcly  not  rsoomuendtd. 
the  previously  outlined. procedure,  where  no  matrix  munipUostlon*  sre  used,  Is  decidedly  euperlor, 

(II)  Equation  (3.33)  1*  extremely  poor  from  speed  oonslderstlone  for  the  oonvenUonsl  method.  It  requires  it 
lent  10  time  ss  lung  ss  (2.30)  for  ths  sxsspls  of  n  »  10  .  This  speed  difforenoe  will  get  even  woree  with 
lsrge  vsluee  of  n  .  Equstion  (3.33)  htt  ths  sdvsntsgs  thst  ths  oovsrlsnos  mstrlx  P  should  teusin  positive 
definite.  However,  there  sre  numeroue  other  wsye  of  doing  this,  go  thst  the  utt  of  (3. 33)  It  not  recommended. 

(III)  Proper  coding  for  both  teohnlquee  should  slwsys  make  the  convent iunsl  method  superior  with  rwapsot  to 
computation  time. 

3,1  Formulation  Using  the  Information  Matrix 

One  may  rssdlly  obtain  s  sat  of  filtering  aquations  whers  ths  lnvtrse  of  the  onvtrlnnoe  matrix  (ths  information 


matrix)  la  used.  The  equations 

sre  as  follows. 

J.d.i  7'ime  Vpdatt 

Let 

p" 1  S  A  ; 

(3.34) 

then 

P‘l(t)  - 

[4p4t  +  r]  " '  *  A(t)  , 

(3.30) 

defining 

*■  lV 

»  R;  *  4‘‘T  A#‘l 

(3.38) 

and 

■  R 

*  &  "i"!  ■ 

(3.37) 

Then  the  1-step  equation, 

Blui  "  Bk 

-  ■fcw1(»iBks1  +  l)'1MjBk  ,  k  «  1.  J 

(3.38) 

yields  ths  result  thst 

P'l(t) 

e  BJm  »  A(t)  , 

(3.38) 

Note  that  the  adjoint  squat ions 

[*-‘]T  -  -rT(t)-[#'l]T  *"lT(t0;t0)  -  i  , 

(3. 40) 

may  bn  unsd  in  plans  of  tbs  transition  matrli  aquations  (2.32).  This  avoids  iny  requirement  for  matrix  inversion. 
It  should  thsrsfors  be  obvious  that*  if  the  squsre  root  matrix  C  la  defined  such  thst 

COT  =  A  , 


(3.  ■»!) 
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then  th*  square  root  matrix  0  say  be  updated  In  tieis  using  Putter's  fnotorlamtlou  of  (3.30).  This  method  wne 
(Ivan  before  *■  part  of  Method  No,  1  for  the  time  update  of  tha  aquaro  root  of  the  covariance  matrix.  Tho  quantity 
$*  *t»  inverted  before,  ualuii  Potter' a  algorithm.  Hers,  no  inversions  are  required,  however,  alnoe  the  information 
matrix  formulation  la  used, 

,3.6,2  ifeaeureaenl  Updati 

In  thie  instance  the  square  root  of  an  equation  of  the  form 

A,  *  A  +  hVh 

is  to  be  calculated.  The  measurements  are  delinod  by 

y  k  Mm  +  q 


(3.42) 


and 


K(dr) 


T\  - 


S  ■ 


Quito  obviously  this  is  the  Identical  problem  to  tho  time  update  of  the  square  root  uf  the  covariance  matrix;  hence, 
if  one  defines 


[C  i  Ht  v^'1)]  , 


(3.43) 


and  uaaa  aquationa  (3.24)  to  (3.27),  the  caluemx  of  the  new  lower  triangular  matrix  0  are  given  by  the  wk  of 
equation  (3.27). 

3.6.3  Slat i  Change  al  Keaeurssenii 

It  ia  well  known  that  tha  gain  X  of  Rquatioh  (2,34)  may  alio  ba  writtin  in  tha  form 

X  "  PjHV1  •  (3,44) 

Tho  0  obtained  aftar  including  moaeurementm  ia  auoh  that 

[COT]  »  p;‘  ,  (3.45) 

If  C  haa  no  aaro  ooiuien  veotora.  Tha  matrix  0  will  be  of  full  rank  if  tha  problem  ia  initialised  with  a 
positive  definite  aovanianue  mmtnlx,  Thie  initiallmtlon  lr  noi  nooesaary  in  tha  lnvuraa  formulation,  ao  tha  gain 
K  al  equation  (3.44)  ahuuld  be  written  ea 

X  a  [CCT]  'hV  1  ,  (3.48) 

In  (3,48)  tha  (I)  aymbol  reads  the  peeudo- inverse.  Tha  faot  that  an  a  priori  information  matrix  la  not  raquirad 
with  this  foraulatlon  can  ha  an  advautaga  in  aoma  problema. 

A*  a  raault  of  tha  mannar  of  (aloulat.ing  0  ,  tha  rank  of  the  information  matrix  la  available: 

rank  b  n  -  nuabar  of  diagonal  tarae  of  0  which  art  Identically  taro. 

Hanoi,  It  X  le  calculated  hy  (3.48),  the  knowledge  of  when  the  peeudo-lnvirte  it  required  la  avallabla.  Also, 
alnoe  0  is  lower  triangular,  inveraion  of  0  directly  (when  it  is  full  rank)  la  recommended.  The  reoomnended 
maimer  of  computing  tha  etata  ohange  ia 


X(T-J)  ■  (D‘lT(D'l(HTQ' '(*-*)))  • 

Calculation*  are  to  ba  oarried  out  in  (3.47)  starting  with  innermost  braoketad  tarma.  In  (3.47) 


■  O' 


if  C  la  lnvartible; 


otAeruiei, 


D'1  *  [PTP] '  l0  . 


(3.  47) 


(3.  48) 


Tha  matrix  t  in  (3.48)  ia  defined  by  shitting  all  uon-sero  ooluana  of  C  to  the  left  to  fora  a  lower  dimension 
matrix.  In  (1.48)  D" 1  la  tha  aqusrs  root  of  the  raaudo- inverse  of  tha  information  aatrix. 

3.6.4  flfieueiion 

Tha  luverae  formulation  glvau  hart  le  approximately  the  same  as  that  of  Reference  14,  He  method  given  usee 
Potter's  equation  tor  the  time  update,  whioh  la  beliuved  superior  to  the  method  of  Reference  14  from  computational 
considerations,  Raferenoe  18  gives  thie  measurement  update  equare  root  technique  for  purpoewe  of  improving 
nuairiutl  ac curacy  of  the  weighted  least  square  type  fitter.  In  thie  latter  instance  tha  estimated  states  are 
held  at  a  fixed  epoch  and  ell  the  measurement*  during  a  given  interval  ara  processed  In  a  "batch"  aohemo.  That  1m, 
the  atata  la  changed  only  ai  a  raault  of  all  tha  maaiuremont*  in  the  batch. 

Rafarcnc*  14  contains  several  example*  which  illustrate  the  superior  accuracy  of  the  aquar*  root  formulation.  . 
An  example  le  as  followe. 
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to 


n  i  * 

Li  1  +  flJ  ' 


*h*r»  *  ii  ion*  small  uunbor.  It  CCT  1*  formed,  then 


0* .  r *  a  *  •  i 

i  *  •  j  +  s° + #j 


Th*  vector  outer  product  given  by 


/  z's  N(j//a  (a+«)//a>  r  a  a  +  »  "1 

\(2  +  e,V2/  (j*  +  •  2  +  2e  +  eV^J 


lu  also  formed.  Comparing  (2. SO)  end  (3. SI)  shows  that  the  only  way  of  diet tngulshing  rank  (2)  In  (3, SO)  is  the 
underlined  o’  as  opposed  to  the  cVz  of  (3.01).  If  en  8  decimal  digit  computer  la  considered,  thou  quite 
obviously  when  C  In  equaled.  (3.50),  rank  la  loat  If  e  Is  enullur  than  about  4  «  10M.  If  C  1b  reduced  to 
loser  triangular  form,  using  previous  algorithms,  then 


t2/V3  0  1 

2  +  *)//2  «/iaJ 


An  nomination  of  the  algorithm  shown  thrt  the  relttlva  size  of  <  to  unity  is  Important,  rather  than  a1  , 
Numerical  rank  would  not  he  loet  here  unleaa  a  la  lesa  than  ipprosimately  1 »  10“ ’  for  an  8  decimal  digit  computer. 

Another  point  of  Importance  is  that,  ones  C  haa  full  rank  It  ippearc  Impossible  to  lose  rank  numerically  by 
adding  very  accurate  observatlone.  Thla  le  not  truo  of  the  information  matrix  formulation. 


4,  TKCIINI QUEN  FOR  COMPENSATION  OP  MODEM  NO  BRROKS 

Th*  statement  of  the  problem  of  Section  a  was  made  in  a  manner  to  emphasize  the  fact  that  many  typos  of  mathe¬ 
matical  modeling  srrorg  can  exist,  Am  waa  montlonod  in  the  real  time  onboard  problem,  one  dealria  to  minimis* 
computational  requirements.  Hanes,  thm  modeling  problem  la  further  aggravated  by  the  duelre  to  keep  calculations 
and  word  lengths  to  a  minimum.  As  a  result: 

(a)  The  number  of  etata  vsriablea  la  minlmimid  by  omitting  ai  many  error  eouroea  aa  poeaible, 

(b)  Closed  form  approximations  are  used  as  muah  as  poaalhle  to  mlnlmice  computer  speed  requirements. 

(o)  The  minimum  sard  length  nay  ba  sought  for  rsduolng  computer  costs,  alia,  and  wiight. 

(d)  Flssd  point  arithmetic  la  dealrabla  from  aomputsr  oomplestty  oonsidsratlons. 

The  ovarall  accuracy' attainable  depends  on 

(A)  Tb*  frequsnoy  and  aoouracy  of,  and  thi  state  specs  spanned  by,  tbs  observations. 

(B)  The  aoouracy  nf  tb*  models  used  In  fitting  ths  data. 

(C)  Ths  magnitude  and  speotrum  of  random  forcing  functions  totlpg  on  tb*  *yst*m. 

Th*  lnt«rr»latlon*hlpi  b*t***n  computational  requirement  oon»id*ratloni  and  attalntbl*  soouraoy  ar*  very  complex 
In  praetlaal  problemi. 

In  this  nation  t«ahnlqu*i  for  dynamio  modil  compensation  In  Kalman  filtsr*  ar*  tddrisisd.  Th*  techniques 
preetnted  will  tend  to  "look"  the  estimate  of  ths  stats  to  the  most  rsosnt  measurements  and  thus  prsvsnt  s 
dlrergano*  of  the  *stimate  from  the  aetsuremsnts.  This  divergsnos  acours  when  on*  sttampti  to  fit  data  over 
relatively  long  tin*  arc*  with  a  poor  dynamic  ood*l. 

4.1  Orbit  littarntnatlun  Example 

Aa  an  axampl*  of  modal  *rror,  an  orbit  doUrmlnatlou  problem  where  position  and  velocity  of  tbs  ipaosoraft  are 
tka  only  amsumsd  stats  variables  is  considered  If  euob  s  constraint  ia  imposed  on  ths  numb*r  of  state  varieblss, 
th*n  It  ll  «asy  to  mow  that  modal  error*  generally  mak*  it  iapussibl*  to  find  a  solution  for  th*  position  and 
velooity  which  fits  the  aotusl  dtta. 

In  this  instance 

i  *  r<x,t)  «.i) 

?  a  Q(X.  t) 


(d.  2) 


8] 


The  problem  of  finding  the  estimate  of  the  initial  state,  Xg  ,  which  mln'mlzos  tiio  loss  function 

L  =  (Y-Y)TQl(Y-Y)  (4  3) 

is  coniidcrud. 

Equation  (4.1)  iapnsoii  a  constraint  on  tho  tlmo  history  of  tho  solution  for  X  if  J(0  is  glvon.  Equation  (4.2) 
givoa  tho  functional  rolationnhip  for  computing  the  observation  frooi  tho  estimate  of  X  . 

The  real  measurements  o'.ioy  reality  rather  than  (4.1)  and  (•*.  2) .  Honco.  If  ono  uses  Equations  (4.1)  and  (4.2), 

a  value  of  X3  for  which  tho  residuals  Y  -  Y  aro  small  and  random  about  zoru  mean,  over  all  time,  implies 

there  aro  no  errors  in  the  mathematical  models. 

Since  a  weighted  Inaat  BQuaros  fit  is  user!  in  this  example,  one  can  hypothosizo  tho  typical  rosidual  behavior 
of  the  solution  for  errors  In  (4  1)  and  (4.2).  A  pictorial  representation  is  shown  in  Figure  j.  The  term  "short 

arc"  .neatis,  for  example,  the  data  during  a  single  paua  of  a  ground  station  for  u  low  altitude  sate  111  to, 

Ah  shown  in  Figure  1.  for  a  short  arc.  dynamic  model  errors  (errors  in  Equation  (4.1))  will  not  prevent  a 
solution  for  where  residuals  ure  essentially  random  with  zero  moan.  This  cap  be  seen  by  conaidoring  a  Taylor 
■erloa  bolution  of  (4.1)  Let  jj9  repreasnt  the  three  position  components  at  the  beginning  of  a  data  aro.  Then 

*(»-**>  =  (~jrs')  + .  (4  4) 


In  tbe  equation,  and  jg  are  free  to  be  estimated,  tad  *  nearly  perfect  fit  out  be  assured  an  long  as  (t-tg) 

la  snail,  regardless  of  the  constraining  effect  oi  the  dynamic  model. 

The  underlined  terms  of  the  infinite  aeries  (equation  (4.4))  are  dependent  on  the  dynamic  model;  hence,  errors 
in  the  dynamic  eerie  1  sill  bocooo  effective  over  long  tine  area.  One  therefore  sill  not  bo  able  to  find  a  value 
of  i0  and  i  vhlch  produces  small  residual  errors,  for  example,  over  a  multiple  pass.  Dynamic  model  errore 
for  data  over  long  time  arcs  should  cause  effects  of  the  type  shown  In  figure  1(b). 

Measurement  errors  such  ts  biases  sill  elao  bare  only  a  small  affect,  for  short  tlmo  arcs,  as  shown  In 
Figure  1(c).  The  error  in  tha  estimate  of  state  >111  Include  the  bias  caused  by  the  measurement  model  error  in 
this  instance.  Only  when  moaeurementa  of  many  different  types  art  processed  sho"ld  biased  offset  residuals  occur 
lor  short  dials  arcs.  This  latter  results  from  tha  .font  that  no  single  virlue*  of  £0  end  XQ  can  be  selectod 
which  fit  multiple  measurements  (more  than  0)  in  the  presence  of  biases  or  other  measuremont  model  errors.  A 
measurement  modal  error,  however,  is.  in  general,  bounded.  Hence.  If  a  long  data  arc  over  many  stations  la 
visualized,  asasurement  model  errors  wuuld  be  impacted  to  cause  residuals  as  shown  in  Flguro  1(d).  Since  the 
solution  is  constrained  to  obey  th-  dynamic  model,  measurement  model  errors  will  have  less  mid  Itss  affect  on 
orbit  determination  accuracy  as  sore  data  Is  processed.  In  those  exemplea  the  errors  are  esuumtd  to  be  small 
(not  mistakes).  Typical  measurement  model  errors  are  station  location  errora,  timing  trrora  and  biases. 

Tha  real  problem,  of  course,  includes  both  measurement  and  dynamic  sodel  errors.  Dynamic  errors  say  have  both 
periodic  and  secular  effects  on  the  residuals  Hence  Figure  1  can  only  Indicate  f  ends  to  be  expected.  Also. 

In  the  general  situation,  what  is  moant  by  short  and  multiple  pass  is  not  readily  defined. 

Figure  2  duplet-,  general  trends  of  the  effects  of  setsurasent  and  dynamic  sodel  errore  on  state  estimation 
accuracy.  The  figure  is  intended  to  indicate  that  dynamic  errors  cause  s  ever-increasing  state  estimation  error 
a*  lore  data  polnta.  over  a  large  time  arc,  are  included.  Measurement  errors  have  the  opposite  effect. 

One  desires  to  have  a  compensation  technique  which  glvae  tbe  beet  balance  between  these  two  effects.  This  will 
be  called  dynamic  model  compensation  and  will  be  discussed  In  the  next  eectlon.  Ono  should  recognize,  however, 
that  both  measurement  and  dynamic  model  errors  exist  and  the  resulting  effect  of  the  dynamic  compensation  can 
oauae  tha  measureaent  errors  to  be  dominant. 

4.2  Dynaalc  Model  Compensation 

As  Indicated  in  thw  previous  section,  aosa.  means  of  preventing  the  state  estimation  errors  rroa  growing 
lodaflrlteiy  la  necessary.  It  should  be  reasonably  obvious  that  one  way  of  preventing  this  growth  It  to  gradually 
reduce  the  Influence  nr  past  aeaeureaenta  In  determining  the  estlaate  from  current  measureaents.  Assume  that  totally 
false  measurements  (outliers)  caused  by  malfunctions  can  be  removed.  The  remaining  neaaurenent*  can  then  be  tr.ated 
to  give  the  theoretical  value  based  on  the  correct  model  plus  an  error  tern.  It  la  reasonably  l'saly  that  upper 
hounds  may  be  placed  on  the  measurement  error.  That  la.  the  error  which  la  caused,  for  tiaorle,  by  calibration, 

atmospheric  effects,  receiver  noise,  and  so  forth,  cannot  be  larger  than  some  specified  number.  If  this  Is  the 

csss,  then  the  error  In  the  computed  measurement  should  be  no  worse  than  this  upper  bound. 

Aa  an  example,  suppose  the  measurement  it  the  propagation  delay  of  an  r  f  signal  between  transmittal  and 

reception  from  i  spacecraft  It  la  reasonable  to  assume  that  the  two-say  range  may  be  computed  from  this 
meaturewnt  and  tbe  upper  bound  on  the  error  In  this  computed  quantity  prescribed.  If  the  residual  Is  greater 
than  this  bound,  one  must  conclude  that  too  much  emphasis  has  be,..  .ced  on  past  data  In  establishing  the  computed 
OibH.  The  author  does  not  moan  to  Imply  that  such  "worst  case"  considerations  ire  to  be  used.  These  remarks 


are  only  isitdo  to  give  some  ronsonn  why  a  reasonable  dogreo  of  trust  in  the  basic  measuremonte  must  be  undo  to 
develop  a  compensation  schomo, 

Two  different  approaches  for  weighting  out  the  influenoe  of  peat  data  in  the  determination  of  the  curront 
estimate  arc  as  followa: 

(1)  Increase  tho  a  priori  covariance  matrix  (or  doorcase  tho  information  matrix).  Arguments  for  uel  this 
approooh  are  as  followa:  Equations  of  motion  which  are  invalid  have  born  used  to  update  the  estimate  of  state.  One 
should  therefore  Increase  the  a  priori  covariance  mutrix  in  accordance  with  tho  orrora  involved  In  tho  tleie- 
updatlnc  of  the  estimate,  The  dlfricultloa  in  unlng  thin  approach  lie  In  defining  tho  roal  error  sources.  Their 
formulation  can  also  become  extremely  complex.  Honco,  for  practical  usages,  It  la  perhaps  hotter  to  soy  that 
pseudo-errors  are  Introduced  to  cause  an  increase  in  the  a  priori  covarlanco  matrix.  These  psoudo-orrore  can  ho 
of  two  types: 

(a)  random  forcing  functions, 

(b)  errors  attributed  to  inaccuracies  of  cuustan,ts  In  the  equations  of  motion. 

(11)  Overweight,  the  most  recent  data.  In  this  uppruaoli  it  is  alnu  recognized  that  the  a  priori  covariance 
matrix  may  ho  overly  optimistic.  The  matrix,  however,  is  not  modified  on  the  basis  of  adding  tho  effeotn  produced 
by  pueudo-arrora  in  the  dynamio  model,  Instead,  a  non-optimal  filter  algorithm  Is  adopted  which  attaches  a  greater 
significance  to  the  recent  observations  than  tho  optimal  filter  does.  Tim  a  posteriori  covariance  matrix  1b 
modified  to  oonform  with  the  nun-optimal  algorithm. 

Either  of  thoso  approaches  has  many  variations  to  suit  any  specific  problem.  Although  the  philosophy  is 
different,  both  provide  a  means  of  developing  a  dynamic  model  compensation  technique. 

4.2.1  Peeudo-Random  Forcing  Function  Approach 

In  tbs  equation  for  time  update  of  the  covariance  matrix,  (2.33),  the  quantity  it  represents  in  added  growth 
in  error  cauaed  by  random  forcing  functions.  Since  dynamic  model  or  computation  errors  would  cause  an  additional 
error  to  exist,  the  natural  fix  is  to  increase  R  .  As  already  mentioned,  if 


=  £  •wi¬ 


thin  tbe  direction  venture  it  and  the  variances  o\  are  to  be  eelectad  for  compensation  of  the  dynamic  model 
errors. 

In  the  real  time  onboard  problem  it  la  likely  that  a  far  more  eccurtte  model  con  be  analytically  defined  thin 
i«  possible  to  calculate.  An  approach  for  defining  tho  errors  is  to  use  a  general  purpose  computer  to  calculate 
the  difference  between  the  assumed  “exact"  solution  and  ths  approximate  solution  as  computed  by  e  simulated 
onboard  computer.  This  difference  (or  error)  data  is  calculated  for  s  number  of  initial  conditions  end  time 
durations.  The  quantities  et  end  crj  ere  then  mdjuated  to  give  a  reseonable  approximation  of  the  error  growth. 
Such  s  simulation  is  likely  essential  in  validating  the  approximations  and  onboard  computational  techniques.  As 
a  result  this  approach  ahould  not  require  a  large  additional  effort.  The  alternate  approach  of  defining  s,  end 
tax  well  as  J)  by  ‘cut  and  try"  experiments  with  tbe  real  system  is  definitely  not  recommended  for  complex 
systems. 

Model  errors  and  computational  errors  generally  cause  bias  type  errors  in  the  estimate.  The  error  eouroea  may 
be  modeled  and  their  effects  Included  In  tbe  filter  in  e  more  direct  manner.  The  theory  for  such  a  technique  is 
given  in  Reference  16.  Fbr  measurement  type  error  sources  this  technique  is  reasonably  efficient,  For  dynamic 
errors,  however,  it  requires  extensive  calculation*  and  doea  not  naceaearily  give  large  reduction!  in  state 
eatlmation  error  over  the  pseudo-random  approach1, 

4.2.2  Direct  Overueighting  of  Most  Recent  Data 

The  paeudo- random  forcing  approach  gives  a  higher  weighting  to  the  aore  recent  measurements  by  causing  an 
additive  covariance  aatrlx  growth  between  measurements.  There  is  no  reason  shy  one  should  not  consider  modifica¬ 
tions  of  the  filter  algorithm  for  achieving  the  overweighting  in  i  direct  Banner. 

One  tucb  modification  is  shown  in  (4.6).  This  modification  tm  tor  sequential  processing  of  tbs  observations 
(one  at  a  time). 

*a  =  *b  *■  (PHT+HToe/HHT)(I-Tb)/(HPHTt  Q)  .  (4.6) 

The  scalar  <  In  Equation  (4.6)  is  a  control  gain. 

If  linearity  prevails,  then  HX(  =  =  the  computed  measurement  after  tbe  observation.  Multiplication  of 

(4. 6)  by  H  glvee 
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Not*  in  (4.7)  that,  (or  e  *  1  ,  the  eutimato  of  thn  observation  is  oqntl  to  tint  observation.  Donee ,  tho  error 
In  tbls  component  of  the  estimate  of  stnte  is  no  worse  than  the  error  in  the  moaBuromont,  Par  e  =  0  tho  optimal 
filter  is  obtainod, 

This  modification  was  suggoiitcd  by  considering  the  fotm  for  tho  estimate  of  state  using  s  single  mnamiiemcnt. 
That  is,  if 

y  =  Hx  +  q  .  (4.8) 

then,  using  tho  pseudo- inverso  tu  csloulnts  tho  estimate, 

I  -  H'y  =  (4.8) 

As  may  be  noted  in  Equation  (4.6),  part  of  tbe  otiungo  in  Xt  la  proportional  to  Equation  (4.8). 

The  covarin.ico  matrix  of  errors  in  X4  is  found  by  taking 

K(X-X„)(X-X,)t  =  P»  . 

This  operation  applied  to  (4.8)  gives 

P.  =  Pb  -  PbHTHPb/(HPbHT  H  Q)  +  tVllTH/[(HPbHTt-Q)(HHT),1  (4.10) 

Ths  underlined  term  of  (4.  10)  shows  the  sdditivo  error  (above  optimal  filtering)  caused  by  the  control  gain  (  . 
Consider  the  following  simple  example,  using  this  non-optlmsl  filter. 


Actual  Model 
1  s  0. 1  =  ■»  scalar 


Anuaed  Model 
i  s  0 
S  =  i  • 


Lot  Q=l. 


P(0+)  =  0 

X(0+)  =  10 

*(04)  =  x(0+)  . 


(after  first  measurement) 
(after  first  measurement) 


Figure  3  shows  thw  sstimats  of  state  after  the  observations  at  two  wwcond  intervals  are  included.  The  estimate 
between  observations  remains  constant. 


The  error  in  the  estimate  for  the  Kalman  filter  grows  indefinitely  with  time.  The  growth  arises  because  x(t) 
was  assumed  to  be  t  constant,  whils  in  reality  x(t)  is  equal  to  a  constant  plus  a  time-dependent  term.  The 
modified  filter  (</0)  has  an  error  growth  between  meisuremsnts.  However,  If  t  =  1,  the  error  in  t  after  the 
measurement  la  lnoluded  Is  no  greater  than  the  measurement  error.  Par  (  <  l  ,  the  error  in  estimate,  aff#r  each 
measurement  is  processed,  has  a  bias  offset  from  ths  measured  value.  Hence  the  usw  of  this  non-optlmsl  filter 
tends  to  look  the  estimate  of  state  to  tbs  recent  observations. 


Equivalent  result*  to  those  given  in  Figure  3  can  bu  obtained  by  Introducing  a  pseudo- random  forcing  function. 
This  can  readily  be  seen,  elnce  random  forcing  functions  cause  on  added  growth  to  P  between  measurements.  Prior 
to  including  the  nth  measurement  for  this  sxampis. 

PB(-)  =  Vi  ♦  R  . 

if  R  were  made  extremely  large  compared  to  q  .  then  the  results  corresponding  to  t  -  1  of  Plgurs  3  would  be 
obtained. 


i  2. 3  Diecuaeion 

Two  techniques  for  dynamic  model  error  compensation  have  been  briefly  described.  In  the  applications  with  which 
the  author  Is  familiar  either  approach  will  prevent  ths  so-called  divergence1.  The  bad  faature*  of  requiring 
“out  and  try"  ars  common  to  both  technique*. 

One  should  note  tbat  both  techniques  can  be  used  to  prevent  loss  of  positive  definiteness  of  tbw  covariance 
matrix.  For  this  application  the  overwelihting-of-moat-recent-data  approach  has  botn  easier  (from  tbe  author's 
expmrieucw)  to  use. 

Other  alternative*  for  model  compensation,  such  si  described  in  References  7  tod  8,  have  not  bsen  covered. 

These  alternatives,  although  applicable,  lead  to  rsisanably  complex  calculations. 


■  »s 
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5.  CONCLUDING  REMARKS 


Th*  over-all  development  of  "aoftwaro"  fur  real  tine  onboard  applications  of  Kalman  filtering  thuory  la  a  very 
complex  subject.  This  chapter  deacrlhed  approaches  and  altorithma  for  solving  aeveral  of  the  probloma  which  occur 
in  these  type  applications  as  well  at  applications  where  larise  general  purpose  computers  arc  available.  There 
are,  however,  many  other  problem  areas  whioh  mutt  be  addrestctl  and  resolvod  in  the  development  of  "appropriate" 
software. 

One  of  the  most  difficult  problems  it  the  definition  of  the  appropriate  mathematical  models.  These  models 
must  be  sufficiently  complex  to  satisfy  the  estimation  accuracy  specifications  yet  simple  enough  for  the  onboard 
computer.  Cleverness  in  the  selection  of  coordinate  tyttems  and  fundamental  state  variables  can  load  to  staple 
formulations.  Approaches  which  lead  to  theso  simplifications  ire  however  more  of  an  "art"  than  a  science. 

The  filter  algorithms  considered  in  this  chapter  were  of  the  "discrete"  typo.  There  are  Instanoca  where 
continuous  filter  theory  may  lead  to  simpler  formulations.  Propagation  of  the  covariance  matrix  kotween  observations 
in  problems  whore  Iho  transition  matrix  is  not  required  la  one  possibility 1 ?. 

Por  high  data  rate  problems  the  filter  equations  derived  from  either  the  discrete  or  oontinuous  theory  may  bu 
too  oompltx  for  the  rial  time  computer.  Data  averaging  or  date  compression  tochniquei  appear  to  offer  a  good 
compromlit  for  handling  iuoh  problems19.  In  applying  auoh  techniques  tone  information  la  lost.  In  addition, 

Improper  formulation  or  inadequate  validation  of  approximations  can  lead  to  unwanted  bias  type  errors  in  the 
•atlmate11.  The  "software"  dosigner  should  therefore  oxerolaa  a  good  deal  of  caution  in  the  application  of  such 
techniques. 

A' 

Prom  the  material  presented  It  Is  obvious  that  many  praotical  solutioni  of  filtering  probloma  axlat.  It  la 
also  obvious  that  the  theory  available  will  not  provide  a  uniquely  optimal  solution  when  ail  fautora  art  considered. 


as 
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CIIAPTKR  4  -  MODEL IN'i  ERRORS  IN  KALMAN  FILTERS 
T.Nlahlmura 


I.  INTRODUCTION 


In  recent  .ear*  th*  Kalman  (liter1,5  has  been  extensively  used  In  such  siipllcatlona  ts  the  tracking  of  missiles 
or  planes  and  the  orbit  determination  of  spacecraft.  One  of  the  problems  arising  in  these  applications  la  that 
very  often  a  proolee  knowledge  of  the  a  priori  statlitici  of  initial  conditions  and  of  the  nolae  model  (process 
noise  and  observation  nolee),  as  woll  as  those  of  system  models,  aro  not  available,  while  it  la  eaoential  for  the 
design  of  optimal  filters. 

For  example,  in  the  orbit  determination  problem  of  spacecraft  in  deep  apace,  tho  observation  la  usually  supplied 
in  tho  form  of  Doppler,  aounted  Doppler  or  range  data,  these  data  are  aubject  to  oeolllator  Instability,  dis¬ 
turbance*  in  th*  ionoaphera,  reoaiver  nolaa,  and  quantitation  noise  of  the  oounter,  which  together  constitute  the 
observation  holes. 

Also  the  epeceoraft  undergoes,  during  its  long  journey  to  the  planet  (a.g. ,  about  300  day*  for  a  typical  Mam 
■iaalon),  various  unknown  dlaturbencee  originating  from  tolar  preaeure,  Impacts  of  meteorites,  and  fuel  leeksge 
from  velvet.  It  ig  a  rather  difficult  task  to  determine  the  etatlstloa  of  any  one  of  these  noise  sourcee.  Besides 
the  unoerteinty  of  the  lnjeotlon  conditions  of  the  apaoecreft,  the  ooordlsattt  after  the  mldoourte  maneuver  may 
enter  into  the  filter  design  end  influence  the  gain  of  the  filter  ttrongly  during  the  initial  period  of  estimation. 

trrora  arc  Inevitable  In  assigning  a  priori  oovnrianet  matrioee  of  large  dimensions,  because  of  leak  of  sutflalent 
experience  or  of  lnaipabllltj  of  analysing  complex  correlations  among  parameters. 

Furthermore  lack  of  precise  knowledge  of  syitea  model!  li  a  problem  whioh  practising  engineers  frequently 
enaounter  In  designing  filters.  Thin  matter  is  also  closely  related  to  the  problem  of  identifloetion,  which  Is 
another  major  topio  Jn  oontrol  theory  end  lte  eppliaetioni. 

In  this  ohsptvr  attention  la  focused  on  the  analysis  of  the  effect  of  error*  in  these  a  priori  etatletloe  and 
system  models  on  th*  performance  of  the  resulting  suboptUal  filter*,  Both  continuoua  systems  and  dlaorete  systems 
are  analysed  and  an  effort  Is  mads  to  find  tha  upper  end  lower  bound  for  the  error  covariances  of  these  suboptlnal 
filter*. 

Tbrouthout  this  chapter  it  is  assumed  that  th*  system!  era  linear  end  that  the  stuohaitlc  variable*  have 
gaussiaa  distributions. 

I,  ANALYSIS  FOR  CONTINUOUS  SYSTEMS 

The  baalo  prooes*  la  described  by  a  first-order  differential  aquation  in  veotoi  form, 

dx(t) 


dt 


■  F(t)x(t)  +  U(t)w(t) 


Th*  observation  is 


y(t>  »  H(t)x(t)  +  a<t)  , 


where  s(t)  it  an  na  vector  of  atstta,  eitb 

l[x(0)]  >  0  . 

7(t)  is  sn  af  veotor  of  observation*, 

s(t)  la  an  n,  vaotor  of  etoobaatlo  Inputs  to  th*  process  with  . 

•  Cw(t)]  w  0 

■  (l(t)w'(T)]  a  8(t)S(t  -T)  . 


whar*  J(t)  la  th*  Dlrao  delta  function. 

s(t)  ia  on  na  veotor  of  tbs  observation  noise  with 
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s[n(t,)n'(T)] 


R( t) 8{t  -v)  . 


(0) 


P(t),  Oft),  lift)  nro  nt  x  n,  ,  n,  x  nf ,  ny  x  n,  metrical  reepeotivuly. 


E C  ]  la  an  expected  value  operator  on  atochaatlo  varlthlee.  It  la  alao  eeiumod  that  the  procoea  noine  w  and 
obaervntion  ncilae  n  have  no  correlation  to  each  other, 


B[w(t)n'(r)]  =  o  . 

Then  the  optima),  oetlaator  x*(t)  of  aft)  which  mlnlmlzaa 

E[Hx*-xll»]  , 

having  tho  obnnrvatlnn  yft)  from  t  -  0  to  t  .  la  doaorlhed  hy  the  differential  equation* 

di*(t) 


(7) 


dt 


=  F(t)x*ft)  i  Kft)  [yft)  -  H(t)x*(t)l  , 


(8) 


where 


Kft)  =  P<t)H'(t)R‘  l(t)  . 

It  in  aaauaad  that  Rft)  la  poaltivo  definite  for  t  J  0  , 

Then  the  covariance  matrix  Pft)  la  defined  by 

Pft)  £  l[(x*ft)  -  x(t)Hx*(t)  -  x(t)>0 
and  It  la  obtained  aa  a  aolutlon  of  a  matrix  Rlcoatl  aquation 


(9) 


(10) 


dPft) 


dt 


*  Pft)P(t)  +P(t)F'ft)  -  Pft)H'(t)R'  lft)H(t)P<t>  +  Oft)Q(t)a'ft) 


(11) 


The  Initial  oondltlona  far  Equation!  (8)  and  (11)  are  reapectlvely 


x*(0)  x  0 


P(0>  »  *Cx(0)x'(0>] 

3.'  ASSUMPTIONS  AND  MATHEMATICAL  DERIVATIONS 


( 19) 
(13) 


,  The  optimal  eetimator  deaorlbad  in  tho  prevloua  aectlon  la  baaed  on  correot  Information  for  Initial  oondltlona, 
nolae  oovarlanoea  end' coefficient  matrloee.  Suppoie  the  eetimator  deaitn  la  baaed  on  incorreot  Information  with 
reapect  to  thong  quantltlea,  namely, 


(1) 

the 

Incorrect 

P0(°) 

rather  than  tha  cornet 

P(0) 

(11) 

the 

inoorreot 

Q0(t) 

rather  then  the  correct 

Q(t) 

(111) 

the 

incorrect 

R0(t) 

rather  than  the  correct 

R(t) 

(iv) 

the  Incorrect 

yt) 

rather  then  the  aorrect 

F(t) 

(V) 

the 

Inoorreot 

o8<‘> 

rather  than  the  oorreot 

0(t) 

(Vl) 

the  inoorreot 
looser  then  an 

H0(t)  rather  than  the  oorrect  Hft) 
optimal  one,  but  bancmea  auboptlmal, 

Thle  euboptlmal  eetimator  la  denotod  x*( t)  end  It  la  deacrlhed  by 
dx*(t) 


where 


P.WsJCtt  +  K,(t)  [yft)  -Hc(t)xJ(t>]  , 
aj<0>  =  0 


K0(t)  «  F0(t)N£(t)li;l(t) 


(14) 

(18) 

(Ml 


and  the  calnuleted  covariance  P„it)  la  computed  by  the 
ldoorreot  model  apaolfled  by  (1)  -(vl). 


Rlcoatl  equation  cm  Equation  (11),  but  ualns  the 


dP„(t) 


dt 


*>  po(t)p0(t)  tp0(t)p^(t)  -  pe(t)H;(t)R;l(tiH0(t)P0(t)  +  o0(t)q0(t)o;(t)  . 


( IT) 


r.  x  , 


•|.V  . 


SI 


Tht  sotual  covsrlsncs  P((t)  la  doflntd  *a  the  error  covariance  associated  with  thf  suboptlmsl  aatluator  of 
Equation  (14), 

Honoa  P,(t)  £  Kt(xJ(t>  -  x(t))(xj(t)  -  X(t» ')  .  (IB) 

This  la  the  covariance  expected  on  the  estlaator  when  there  ta  Insufficient  information  on  tho  design 
parameters.  It  la  the  male  objective  of  thla  asotlon  to  derivo  equations  describing  this  Pk(t)  . 

For  thla  purpose  it  la  easier  to  derive  a  differential  equation  for  Pa(t)  . 

Thus  differentiation  of  Pt(t)  of  Equation  (IS),  and  a  change  In  the  order  of  the  differentiating  operator  and 
the  expected  value  operator,  ylold 


Pm(t)  =  EUiJ(t)  -  x(t))(x*(t)  -  x(t))']  +  Ef(xJ(t)  -  x(t))(xj(t>  -  x(t))']  , 

(19) 

However,  from  Equations  (1)  and  (14), 

x*(t)  -  x*(t) 

a  (PQ(t)  -  K0(t)ll0(t))(xJ(t)  -  x(t) )  +  AF(t)x(t)  -  KQ(t)AH(t)x(t>  +  K0(t)n(t)  -  0(t)w(t)  , 

(20) 

where 

AF(t)  «  F0(t)  -  F(t) 

(31) 

AH(t)  *  H,(t>  -  H(t)  . 

(23) 

Also,  x(t) 

la  obtained  from  Equation  (1)  aa 

x(t)  =  U(ti0)x(0)  +  /‘uft.sJOfalwfs)  da  . 

*0 

(23) 

where  U(t,a) 

is  defined  by 

3U(t,  a) 

— - —  =  F(t)U(t,  a).  , 
ot 

(34) 

with 

U(»,i)  *  I  »  t  *  8  *  0  ( 

(35) 

and  I  la  an  Identity  aatrlx, 

Furthermore  x*(t)  la  derived  from  Equation  (14)  as 

xj(t)  --  jSgd.s) Ke(a)y(i)  ds  ,  (») 

ehtrs  Vo(t,  s)  Is  deflnsd  by 

1  <ro(t>  "  Vt,Mo(t))Vt,,)  •  t  >  s  >  0  .  (21) 

ot 

then  xj(t)  and  xj(t)  are  substltutsd  into  Iqustloo  (18),  togsthsr  with  x(t)  of  Equation  (30)  and  Its 
solution  x(t)  In  Equation  (33),  paying  sttantion  to  ths  fsot  that  w(t)  and  n(t)  are  unoorralatad  white  nolaea, 
tht  following  thra*  differential  aquations  are  derived1: 

S  (F  (t)  -  E.jCUH^DJP.tt)  >P»(t)(F0(t)  -  K0(t)Ho(t»'  t 
dt 

+  (AF(t>  -  KB(t)AH(t))A(t)  +  A'(t)(AF(t)  -  K0(t)AH(t))'  + 

+  Eg(t)E(t)Kg(t)  t  0(t)8(t)O'(t)  (2«) 

a  P(t)A(t)  +  A(t)(F„(t)  -  K  <t)K  (t))’  f  F,(t)(AF(t>  -  E0(t)AH(t»'  -  0( t) «< t > 0 '( t)  (29) 

dt 

3  F(t)P,(t)  +  Pj(t)F'(t)  +  0(t)Q(t)0'(t)  ,  (30) 


wher*  A(t)  and  Pt(t)  are  doflned  by 

A(t>  $  Elx(t)(xJ(t)  -  x(  t) )  '] 

P,(t)  i  E[x(t)x'(t)]  . 

The  Initial  conditions  lor  those  differential  equation's  tro  respectively  given  by 

P,<0)  =  P(0) 

A(0)  =  -P(0) 

P,(0)  «  P(0)  , 
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4.  EKROK  BOUNDS  OK  SUDOPTIMAL  Fit, TEIIS  (CONTINUOUS  CASE) 

When  both  process  matrix  F  and  observation  matrix  H  arc  known  correotly,  the  results  In  the  previous 
aoctlon  can  bo  simplified  oansldorahly.  In  feet,  only  thu  first  differential  otiuntion  needs  to  bo  solved’. 

-  ■  ff(t)  -  K0(t)H(t))P,(t)  +Pt(t)(P(t)  -  K0(t)H(t))’  +  K0(t)R(t)K;<t)  +  Q(t)Q(t)Q'(t)  , 


Let  !ot(t)  be  the  difference  between  the  computed  covariance  P0(t)  ind  the  actual  oovarlsnce  Pt(t)  ,  then 

*„(t)  “  «Vl>  “  Vfc'  •  <»»> 

Substituting  this  Into  Equstiun  (36)  yields  tho  following  differential  equation  of  H0l(t)  ,  with  tho  aid  of 
liquation  (17)! 

i0,u>  »  (r<t)  -  K0(t)H(t))«0,(t)  +K0,(t)(r<t)  -K0(t)H(t))'  +  Kc(t)fdt(t)K'(t)  t  a  cl)  a '  ( t>  ,  "'.f4o> 

!*'  <'  1. 

■here  All(t)  and  AQ(t)  are  the  differences  between  the  incorrect  noiee  covariances  and  the  correct  onwip  usdfil 


-‘'I-*'  a*- V 

*»"*  «  1  t  4  t  M  ■  h  •  •  <4  ■ 

-  VgV„A>  V*/  "a- 


Q0(t>  -  Q(t>  . 

■  -A  j  >  •*  N,;  \ ,/  r 

.  .«tP  .  -1 


ehere  All(t)  end  AQ(t)  are  the  differences  between  the  incorreet  noise  covariances  and  the  correct  onsip  nsdfily 

,  .  v  ,  W>  *■  A 

,  All(t)  =  H_(t)  -  R(t>  •  f;’.  tfX1  ‘V  (41)-  1 

•  .  .  «\  .  •AV.'.ii M 

*  Q0(t)  -  Q(t)  .  ^  \  ; 

■  /•  .  (-  >■'  ,S»M 

■lnoe  Equation  (3»)  la  a  linear  differential  equation,  ah  explicit-analytic  solution  can  be  derived.  <  ■ 

*  ft  h  *,  vjfr  ■  ■'<  \‘  <  f  A'y{  ■ 

«„(t)  •  va(t,o)i0i{oiv;(t,o)  t  v4cj‘.4>y9^)K>)vg'(tHya^.si  ^  * 

•,, ,  ■  ft  1  ,  ,r  -j"  .1  •  T,  ,  ' .  * 

■  +  /  V0(t,.e)5j(«)flQ(»)a'.(e)V;(t1ul.  ds  .  /  v  (#3)  ■ 

.*■  5  "7  .  ^ 

As  obeerved  from  the  Equation  (43),  E„t(t)  li  a  eum  of  real  symmetric- matrices,  eo  that  'Sjnillpaaplivs 
definite  provided  every  ten  in  the  riaht-hand  aid#  of  Equation  (43)  le  mb  1- positive  deflate,  Because  of  <thij;.  \ 
apeolfio  (aynmetrlc)  configuration  of  thsae  tsras,  every  ons  of  them  will  be  respectively  . qsijii -pool t t^-s  dul,lnl';t  ((V 
It  every  aatrlx  st  the  winter  of  the  respective  tera,  namely  Eg|(0)  ,  AX(s)  .  end  *($l(s)  ’Vor  ,t  )  s<5  0.  '  J 

eeal-poaltlve  deflnlts.  ’  ■  V.  .. 


As  obeerved  fron  the  Equation  (43),  Eca(t)  li  a 
definite  provided  every  ten  in  the  riaht-hand  aide  i 
speolfio  (eynmetrlc)  configuration  of  theae  terms,  • 
It  every  aatrlx  at  the  winter  of  the  respective  tera 
aaal-poaltlvs  definite. 


n  - 

(said  on  this  dlscuaelon,  the  followlni  theorem  can  be  derived  ,  <' 

Tbtortm  1 

■0K(t)  )  0  ;  hence  Pg(t)  J  P((t)  for  t  )  0  If  the  condition  C-I  la  satisfied. 

C-l :  Eo,(0)  J  0  ,  AQ(t)  i  0  ,  end  AR(t)  i  0  ,  or  equivalently  P„(0>  J  P,(0)  ,  qo(t)  J  Q(t)  ,  end  R„(t)  ?  R(t) 
for  t  t  0  , 

The  lapllcetlcn  of  the  Inequality  sign  (plus  equality  sign),  e.g.,  P0(t)  >  P((t)  ,  lr.  that  ths  dlffsrsncs 

aatrlx  P0(t)  -  Pt(t)  Is  seal-positive  definite. 
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Therefore,  an  Upper  hound  far  the  variance#  of  the  eubaptlmsl  estimator  x*(t)  oui  be  eat,  and  It  la  equal  to 
tht  diagonal  component*  of  the  oaleul  atod  oovarlanee  Pa(t)  alien  the  oondltlnn  C-I  la  aatlatled,  The  lower 
bound  of  thoeo  varlancee  la,  of  course,  enro,  do  lot  pol((t)  and  p|(1(t)  bu  roapeotlve  diagonal  component* 
of  P0(t)  and  P4(t)  ;  then 


Polift)  J  P,u(t)  1  0 


(44) 


Even  though  the  dealgnnr  doe*  not  know  exaolly  the  a  priori  atntUtloa,  he  ean  expect  that  hla  aubuptinml 
eelmator  will  properly  hohave  within  the  specified  rango  pruvided  the  oonaervatlve  condition  C-I  la  aatlatled. 

Though  It  la  of  leas  practical  Importance,  the  following  Corollary  la  derived  from  Equation  143). 

Corollary  1 

«„(t>  $  0  ;  hence  P0 f t)  S  Pa(t)  for  t  )  o  if  the  condition  C-tl  la  satisfied, 

C-1I:  Eol(0)  <0,AQ(t>  $  0  ,  ami  AR(t)  SO  or,  equivalently,  P„(0)  S  P,(0)  ,  Q0(t)  5  «(t)  ,  and  I 
for  t  }0  . 


are  defined  aa 


will  be  derived. 


B10a>  *  P,(t)  -  P(t) 


«W‘>  5  P0(O  -  , 


Plret  Ea0 (t>  can  be  obtained  ee  *  difference  between  Pa(t)  and  P(t)  given  by  Equation*  (38)  and  (11), 
raapeetlvaly: 

it0(t)  »  (F(t)  -  K0(t)H(ty >E-0(6J  +  Et0(t)(P(t)  -  K0(t)H(t) ) 1  + 

+  <Ke(t)R(t)  -  P(t>H'(t))*(t)*1(K0(t)R(t)  -  P(t)H'(t))',  (47) 

Whan  a  alwl.lar  dlaouaslnn  leading  to  Theorun  1  la  appliod  te  Equation  (37)  It  may  be  concluded  that  EaJ(t) 
ll  always  leml-poaitlve  doflnita  for  all  t  i-0  ,  beoauna  R(t)  te  poaitivw  definite  by  aaeumptlon  and  Ea„(0) 
la  noml-poaltlve  definite,  aa  deduoed  from  th*  definition  of  P(0)  ,  This  1*  described  In  the  following  theorem. 

Thtort*  2 

E,0(t)  i  0  ;  hence  Pt(t)  S  P(t)  for  t  *  0  . 

This  reault  ean  naturally  be  axpactwd  becauat  p(t)  la  the  minimum  vailano*  by  definition, 

Similarly  the  dlffarentlal  equation  for  Eo0(t)  in  derived  by  aubtraotin*  P(t)  of  Equation  (11)  from  P0(t) 
of  Equation  (17), 

EaJ(t)  W  (P(t)  -  E0(t)H(t))Eo0(t)  +  Eo0(t)(r(t)  -  ltfl(t)H(t)) '  + 

+  E110(t)H,(t)li;,(t)H(t)EM(t)  t  U(t)AQ(t)(l'(t)  + 

+  P(t)H'(t)(R(t)(AR(t))'  'R(t)  +  R(t>'  H4(t)P(t>  for  AR  >  0  .  (48) 

Again,  It  la  altar  frexa  this  aquation  that  E?,<t)  la  aenl-poaitlv*  dafinite  if  C-I  la  aatlatled.  When 
AR  ■  0  tha  same  conclusion  can  be  proved  by  taking  a  limit  AR  -  0  . 

Thua  th*  following  theorwm  1*  obtained. 

Thiortn  3 

It#  }  0  ;  heno*  P„(t)  i  P(t)  for  t  3  0  ,  If  C-I  le  eatlefled. 
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1.  ANALYRIR  POR  DISCRETE  RYITCMS 

In  thla  aeotion  the  ewe  technique  la  applied  to  discrete  eyateae  and  almllar  result*  are  derived,  Symbol* 
are  defined  In  the  asm*  manner  aa  In  th*  continuous  ayatema,  and  similar  assumptions  are  eada  concerning  modeling 
error*  and  nolt*  itatlatlca. 


VV* 


k  v  .v. 


-j 


The  process  squetlon  end  observation  dilutions  srs  respectively 


x(k  +  1)  =  <ftk)x(k)  +  0(k)w(k)  (40) 

y(k)  =  M(k)*(k)  +  n(k)  .  (80) 

Then  the  optimal  estimate  x*(k  ♦  1)  having  the  Information  Y(k)  =  [y(0),  y  ( 1) ,  ....  y  (k)  ]  Is  given  by' 

x*(k  + 1)  -  |t(k)**(k)  4  X(k)(y(k)  -  H(k)x*(k))  ,  (81) 

wliet'a  K(k)  =  4*(k> P(k)H ' (k)  [H (k) P(k)H ' ( k)  +  R(k)]'1  (83) 

**(0)  -  0  .  (83) 

TtiB  covariaiioe  matrix  P(k)  Is  dufined  by 

P(k)  *  B[(»*(k)  -  x(k))(x*(k)  -  x(k))']  (84) 

and  it  is  governed  by  the  nonlinear  dlfferonou  oquntlon 

P(ktl)  =  ($(k)  -  K(k)M(k))P(k)($(k)  -  K(k)H(k)> '  +  K(k)R(k)K(k) '  +  a(k)Q(k)0'(k)  ,  (88) 

With  P(O)  s  c[x(0)x'(0)1  .  (86) 


When  tho  lnoorreot  node  la  which  Are  the  counterpart*  In  disorat#  ayetetna  of  those  described  in  are 


used,  the  reaultini  auboptlraal  estimator  *J(k)  la  computed  by 

xj(k  +  t)  «  tc(k)xj(k)  +  K?(k)(y(k)  -,He(k)iJ(k))  ,  (87) 

with  K0(k)  v  4„(k)Pc(k)tl^(k)  [Hc(k)Pe(k)H^(k)  +  R0(k>  ]" 1  (88) 

*;<0)  *  0  .  (88) 

Ths  calculated  covariance  Pg(k)  la 

p0(krl)  »  (*0(k>  -  K0(k)H0(k))P0(k) <*0(k)  -  K0(k)H0(k)V  +  K0(k)R0(k)K '(k>  +  o#(k>q,(k)o'(k>  .  (flo) 

The  actual  oovarlanca  aaacolatad  with  this  auboptlmal  aitlraator  x*(k)  la  daflnad  aa 

Pt(k)  $  «[<xj(k)  -  *(k)Kx*(k)  -  x(k))']  .  (fli) 


Tha  raourrancs  equatioua  daacrlblng  this  Pa(k)  art  darivad  In  a  alMllar  rannar  to  tha  continuous  oast15. 

P,(k  + 1)  v  <*0(k)  -  K0(k)H0(k))P,(k)($„;k)  -  K0(k)H0(k))'  t 

+  (A*(k)  -  Ka<k)AH<k))A(k)(<8c(k)  -  K0(k)H0(k)) '  + 

+  (*0(k)  -  Kc(k>Hc(k)>A'(k)(A$(k)  -  K0(k)AH(k)) '  + 

+  (A<Nk)  -  kc(k)AH(k)>PI(k)  (iftk)  -  K0<k)AH(ki) '  ♦ 

+  Ke(k)Mk)K'<k)  ♦  0(k)«(k)0'(k)  ,  (63) 

A(k  +  1)  *  $(k)A(k)(*c(k)  -  k0(k)H0(k)) '  +  ${k)P,(k)(ilfck)  -  K0(k>AH(k)) '  -  Q(k) q(k)Q '(k)  (81) 


P,(k  +  l)  a  $(k)P,(k)i8'<k)  +  Q(k)8(k)0'(k)  , 

■tor*  A(k)  and  P,(k)  are  daflnad  by 

A(k)  §  B[x(k)(xJ(k!  -  x(k) ) ') 

P,(k)  $  cCx<k) * ' (k) 1  . 

Tha  Initial  condltlona  fur  these  recurrence  equation!  era  respectively  given  by 


0) 


(84) 

(88) 

(86) 

(67) 

(68) 
(60) 


.k. '  %  , 


•vvv 


P.(0)  =  P(0) 


8,  ERROR  lHUINUS  OF  SUROPTIMAl,  KI1.TKRR  (DtHCRETK  CASE) 


When  the  proooM  trotultlon  matrix  4'( k)  und  thu  obeorvation  matrix  ll(k)  ere  perfectly  known,  only  tho  first 
r*curr»nce  equation,  Equation  (h),  nuods  to  be  xulvad  in  ordt'r  to  find  P,(k)  .  Namoly11'*'1' 

P,(k  +  l)  -  («(k)  -  K0(k)H(k))P,(k)W(k)  -  K0(k)ll(k)V  t  Ka(k)R(k)!^(k)  +  0(kl(|(k)a'(k)  ,  (70) 

Then  the  difference  matrix  F0B(k  +  1)  between  P,(k  *  1)  and  Pa(k  + 1)  of  Equations  (03)  and  (50)  reapuctivuly 
bacons* 

Eal(k  +  1)  --  (4>(k)  -  KaOOII(U)>E0|l(kl (<tOO  -  Kd(k)li(k))'  +  K0(k)AR(k)K'(k)  +  d(k)Q(k)n'(k)  .  (71) 

where  B0i(k)  =  P„(k)  -  P,(k)  .  (72) 

Following  tho  samn  dlar.uBMloim  used  la  tho  continuous  caaa  aa  woll  *h  tho  lnduotlon,  tho  following  thoorom  can 
bo  dorivod  for  dlaorota  eystomu. 


Thtortm  ti 

E0,(k)  3  0  ;  honoa  P„(k)  ?  P,(k)  for  k  3  0  if  tha  condition  C-m  la  satisfied, 

C- nil  Ecil(0)  3  0,  Ad(k)  3  0  and  AR(k>  3  0  or  oqui*»lantly  Pa(0)  3  P4(0>  ,  Q0(k)  >  «(k)  and 
R0(k>  3  R(k)  for  k  3  0  . 

Alio  tho  countsrpart  of  Corollary  1  1*  darlvad,  which  yialdi  th*  lower  bound  of  t*a(k>  . 


Corot  lory  2 

Bci(k)  <0  :  hano*  P0(k)  i  Pd<k)  If  th*  condition  C-III  1*  aatiafiad. 
In  tho  aaau  of  the  other  two  dlfferennea, 


■  ERg(k)  »  P1(k)  -  P(k) 

««(«  «  P„00  -  POO  . 

result*  *imil»r  to  tha  oontinuou*  c»aa  oen  b*  proved. 


(13) 

(7A) 


Piret  Equation*  (80)  and  (70)  ar*  substituted  into  Equation  (73)  and  *ft*r  aertaln  manipulation  of  metric** 
th*  follawlri*  matrix  form  can  bo  derived. 

|„(ktl)  «  (*<k)  -  K_(k)H(k))Efl0(k) (4l(k)  -  K„(k)H(k))'  +  (K„(k)  -  E(k))8(k)(K#(k)  -  K(k))'  ,  (75) 


where 


"lj,  '  "o'"'"'""  ’  '  'o' 

8(k)  «  H(k)P(k)H'(k)  +  *(k) 

8e(k)  «  H,;(k>P0(k)H£<k)  ♦  *0(k)  . 


(70) 

(77) 


In  this  derivation  tha  followln*  relation  is  ueeful: 

K0(k)  «  K(k)  ♦  (<Nk>  -  k(k)H(k))E00(k)H'(k)S^ l(k>  -  K(k>AMk)s;‘(k)  . 

In  view  of  Equation  (73),  th*  followln*  theorem  1*  derived, 

7fcior*s  3 

■M(k)  >  0  ;  hence  P,(k)  3  P(k)  for  k  >  0  , 

Thle  le  a  natural  ooncluelon  heoauae  P(k)  la  the  optisum  onvarlanoe  by  definition, 

Por  the  third  difference  setrix  *00(k)  the  folioein*  relation  is  obtained: 

E„,(kM)  *  (♦(«  -  K#(k>H<k))Ec0(k)(<JW  -  K0(k)H(k)V  - 

+  (Ka(k)  -  K(k))S(k)(K0(k)  -  K(k)) '  ♦  K0(k)AR(k)K^(k)  +  fl(kiA«(k>o'(k)  . 


Then  the  followln*  theorem  la  derived. 

Theorem  fi 

E  „(k)  3  0  ,  lienoe  P„(k)  i  P(k)  for  k  i  0  ,  if  c-Ul  l*  latisflwd. 


7.  EXAMPLES 

Two  examples  demonstrate  the  theoretical  analysis  of  this  chapter.  Thu  first  example  la  concordat!  with 
modeling  errors  In  the  a  priori  ntttlatlos  end  the  socond  oxmuplo  with  the  aystom  modeling  errora, 

t'xamp  It  1 

A  spacecraft  is  cruising  with  o  constant  speed  along  a  straight  lino  and  Information  in  supplied  by  the 
data,  which  arc  contaminated  by  white  noise  having  the  spectral  density  and  zero  mean. 

Lot  ij  and  x,  bo  dovlatlons  of  speed  ant1  position  of  the  spacecraft  front  the  stsnderd  trajectory, 
respectively.  Then  the  process  equation  bocomen 

ijft)  =  0 


The  observation  equation  is 


Thorafors 


Xj(t)  c  Xj(t) 


y(t1  =  x,(t)  +  n(t)  . 


■[::] 


lift)  m  [0,  l] 


C(t)  =  0 


*<t)  =  4,  . 


The  a  priori  covariance  Is  chosen  as 


P(0)  k 


Pn<0)  0 

0  P,.«J) 


Than  the  covariance  P(t)  of  the  optimal  estimator  la  derived  from  Equation  (11). 


P(t)  s 


t  fpu(t){l  +  p„(0)t/$r)  ,  Pu(0)t(l  +  p ,,(0)t/24>r) 


ZU>  pu(0)t(i +p„(0)t/a#r)  .  p,,(0)  tp„(0)t'  t  Ptll0)p^-»(0U- 


z(t)  -  l +[a„(0) +pu<0)t4/3 +p11(0)p„(0)tVi2$r]t/*r  . 

Suppoae  that  the  lneorrect  model  actually  used  In  the  design  of  the  suboptlmsl  estimator  la  given  hy 


P„<0)  = 


Poll<°>  » 


PU(0)  +  eu(0) 


*ro  =  *r  +  Ar  ■ 


0 

t  •  „«»_ 


Than  the  diagonal  components  of  E0|(t)  are  computed  by  Equation  (38). 


•«.!!<«  *  *n<t)  +  »ii<‘> 


*•.!<»  =  [•li<0)(l+poll(0)t/*r#),  +  *.i<l»Pj.iW>*V«*;.] 
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(94) 


and 


Vl)  1  1  *[W°>  ♦P,ll<0>t73  *  Po„<0)Pcl,(0)lVl2«rc]t/*rs  . 


Alio 

ehera 


(95) 

(00) 


•»(t>  1 


Z„(t) 


+  P0„«»t/2<trc)V  +  e„(0)(l  -  pcll(0)tV6*rB) *] 


(97) 


ARt 


*  4»i(t)» 


<»e»i«»  +  W°>^2  ♦  Poll(0)peJf(0)iVi24Vo)»  ♦  hi^pl  U  ♦ 


1 98) 


Jn  Figure  1  tho  optimal  variance  p?J(t)  and  actual  variance  pCJJ(t)  of  position  of  the  spacecraft  are 
depleted  using  pou(0)  aa  a  parameter.  The  computation  of  the  optimal  variance  p,,(t)  la  based  on  the  true 
model.  ’ 


The  auboptimal  filter  la  designed  In  such  a  way  that 


»„„«»  >  p„(0) 


and  using  pou(0)  as  a  parameter. 


The  figure  Indicates  that  the  variance  of  tho  auboptimal  filter  la  Quite  sensitive  to  variation  of  p  (0)  , 
i.e.,  the  Incorrect  Initial  speed  variance.  Cue  (a)  la  when  an  axoesalvaly  large  a  priori  uncertainty  of  speed 
wag  employed,  i.e.  ,■  Pou(0)  s  lOp^fO)  .  On  the  other  hand,  ogee  (e)  Is  whon  the  a  priori  value  taken  wu  emeller 
then  the  true  value,  nemely,  pcll(0)  -  ipjjfO)  .  For  both  cues  significant  overshoots  of  the  varianoe  are 
observed.  Ttile  Is  because  the  gain  Kc(t)  was  Ill-conditioned  for  both  axtremi  cases,  In  other  words,  sufficient 
wight  had  not  been  assigned  to  the  Information  during  the  Initial  period  so  that  the  station  did  not  track  tho 
spacecraft  pioperly.  Cut  (e)  especially  demonatratoa  how  thw  estimator  oan  behave  poorly  when  an  optimistic 
selection  ig  made  on  the  a  priori  covariance. 


In  Figure  3  the  calculated  variances  p011(t)  used  In  this  cue  are  plotted  for  the  sane  psrueters. 


Figure  3  la  the  caee  when  the  varianoe  of  Initial  position  p  ,(0)  la  changed  aw  a  paramattr.  It  can  be 
served  that  the  auboptimal  ftltsr  la  not  so  sensitive  to  the  initial  uncertainty  of  position  aa  to  that  of  a 


observad  tnac  tne  aunoptimai  niter  la  not  so  sensitive  to  tha  initial  uncertainty  of  position  aa  to  that  of  speed. 
However,  case  (d)  reveals  a  degraded  performance  of  the  filter  when  t  smaller  value  Is  picked  up  for  the  positional 


uncertainty  than  the  true  value. 


Pe.»<®>  “  • 


»*  Figure  4  the  Incorrect  Information  4ro  of  the  power  apaotral  denaity  of  the  observation  nolas  is  employed 

u  a  parameter. 


Tha  auboptimal  filter  bshavsa  very  poorly  for  $  .  which  la  tlther  vary  large  (eggs  (g);  $  =  10  4  )  or  vary 

small  (case  (d);  4rc  =  t<fr)  compartd  to  the  true  4r  . 


Figure  5  Is  one  eseople  of  varlanoea  of  speed  of  the  spicecraft,  corresponding  to  case  (g)  of  Figure  3. 


‘Extop  1 1  2 


An  exponentially  correlated  aljnal  la  processed  by  a  aequentlal  continuous  detector  which  la  contaminated  by 
additive  white  noise.  Let  x  be  the  eignal,  then 


x(t)  =  -  /3x(t)  +  w 
y(t)  *  x<t)  +  n  , 


(99) 

(100) 


sfcert  w  and  n  are  uncorrelated  white  nolle  with  xero  mein,  having  power  spectral  denaity  q  and  r 
reapeotively. 


It  la  isaumid  that  the  variance  ojj  of  signal  la  known,  but  Its  correlation  time  t(=  1//T)  is  not  exactly 
known  a  priori.  Hence  tn  approximate  value  v  (=  1/0  )  la  employed  In  deeignlng  the  filter. 
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Thu  i 

4,  1  /»*A0. 

M*u  it  In  assumed  thnt  a  sufficient  time  Is  assigned  for  tracking  compared  with  the  correlation  time  of  the 
signal,  ao  that  only  steady- ntato  aolutions  of  Rlccatl  aquations  which  are  the  limiting  valuos  as  t  -  a>  are 
investigated. 


Hie  purpose  of  the  subsequent  analysis  is  to  find  the  effect  on  the  filter  performance  of  deviation  of  tho 
assigned  correlation  time  from  its  true  value.  Tito  Rlccuti  equation  of  the  optimal  variance  p(t)  associated 
with  tho  eatiaator  **(t)  becomes 


P(t) 


2A>ft)  -  — —  +  q  . 
r 


(102) 


At  the  steady  state  p  —  0  ;  hence  the  steady  state  aolutlon  pt  is  computod 

Pu  =  -Atl^r'  '  rq)1'*  (103) 

share  q  =  Jfa*  .  f  104> 

(ki  the  other  hand,  the  actual  fllttr  design  is  based  on  lnoorroct  Itnowlttlge  of  the  correlation  time  (or  /?0). 

Thus  tha  steady-state  value  pok  of  the  calculntod  variance  is  given  by 

Pc,  =  -  fitr  *  (Hit1  ♦  rq,)  (100) 

Q,  -  .  (tofl) 

The  aotual  variance  pft(t)  sssoolstsd  with  tha  euboptimal  estimator  xj(t)  which  In  designed  using  this  P0(t) 
la  determined  from  the  following  three  differential  equations: 

P,(t)  »  -  2 [/30  +  p0(t)/rlct(t)  -  2A/3A<t)  +  pj(t)/r  i  q  (107) 

M t)  =  -  C/3  +  /?„  t  pa(t)/r]A(t>  -  ^(t)  -  q  (108) 

£„<t)  »  -  J/tojd)  +  q  .  (100) 


The  ateady-etate  solution*  of  that*  equations  are  computsd  and,  after  aoeie  manipulation,  the  steady  state  value 
pM  la  found  as 


p 


w« 


_ _ «Pe.g^ _ 

c*  <»o.  +  ^o^o.  +  ' 


(110) 


This  pt(  becones  a  minimum  at  A/1  =  0  and  It  la  oqual  to  tha  optimal  valua  p,  .  It  la  notioad,  however, 
that  as  the  assigned  correlation  time  becomes  shorter  p(>  approaches  crj  . 

/3„  -  a  ,  p„,  -  crj  ,  pM  -  o'  . 

Also  as  tha  asaignod  oorralatlon  time  becomes  longsr,  tgaln  p|(  approachso  crj  . 

-  0  •  S>cs  “  0  •  Pa.  -  °x  • 


In  hoth  extras#  oaaaa,  tha  flltar  la  ao  111-oondltlonad  that  tha  estimation  of  tha  signal  la  not  performed  at 
all,  Hanca  any  deviation  of  tha  assigned  oorralatlon1  tlma  from  lta  true  value  in  either  diraotlon  will  result  in 
an  Increase  of  the  aotual  variance.  Tn  Figure  8,  pm  la  plotted  agalnat  A/V/3  for  unit  value  of  r  and  a J 
raapaotlvaly. 


Tha  ratio  between  the  maximum  dwrlatlon  of  pt| 


»e 


end  the  optimal  value  p 


la  computsd  aa 


(111) 


This  a  providis  tha  range  of  the  probable  deviations  of  tha  euboptimal  filter  performance  from  that  of  tha 
optimal  one. 


a.  CONCLUSION 


'.I 


w'-V-V-V-V-V 


Tito  algorithms  for  evaluating  thu  offoct  of  orvnra  due  to  moiiuUn*  errors  in  tho  Kalmar  filter  hnvo  buBii 
presented  In  this  chapter  for  both  continuous  and  discrete  systems 

Alan,  the  error  bound  of  tho  Kalmnn  filter  has  boen  studied  when  tho  incorrect  a  priori  statistics  on  Initial 
conditions  as  well  as  on  rnlxo  models  aro  employed.  Die  conservative  dcsiim  criterion  oiprossed  In  Ttiunri'ms  1  and 
4  guarantees  that  tho  xuboptlmal  flltur  satisfying  It  remains  within  the  specified  range  over  the  estimation  period. 
Also,  tho  formulao  of  Equations  (28)  -  (31)  for  continuous  systems  and  of  Equations  (02)  -  (64)  for  dlncrote 
ay at erne  supply  the  necessary  Information  to  evalusto  tho  effect  of  errors  qualitatively  for  parametric  studlus. 

Buch  porametrio  Investigations  are  very  Important  to  find  out  to  what  oxtent  cnnsurvatlvr  assignment  of  o  p-inri 
am  levies  and  noise  moUuln  can  bo  made,  because  largo  covariances  of  Initial  coordinates  and  noises  tend  to 
incroaso  the  oovarlance  of  estimates  and  eventually  to  slow  down  Its  convergence,  thus  deteriorating  tho  sensitivity 
of  the  filter. 

Tho  first  oxample  of  this  chapter  well  demonstrates  the  Importance  of  profllcht  parametric  studies  when  estimtt- 
tlona  are  to  bo  carried  out  in  rathor  short  periods.  An  optimistic  selection  of  the  a  priori  statistics  (smaller 
values  of  Pc(0)  ,  d0  ,  and  Rc  than  true  values)  la  especially  dangerous  because  It  prevents  tho  estimator  from 
having  a  proper  gain  K(t)  during  the  Initial  period  of  estimation  (case  (e)  of  Figure  1,  case  (d)  of  Figure  3 
and  case  (d)  of  Figure  4).  On  the  other  hand,  it  has  been  observed  in  examples  that  an  excessively  conservative 
choice  may  tlso  be  harmful,  because  It  frequently  results  in  a  large  offaat  of  suboptlmsl  covariances  from  the 
optimal  ones  it  the  and  of  the  estimation  period  (esse  (•)  uf  Figures  1,  3,  and  4). 

The  second  examplo  la  Intended  to  study  the  Influence  of  correlation  time  on  tho  auboptlmal  filter  porforminoe. 
This  la,  again,  an  important  problem  in  space  missions  because  it  Is  often  difficult  to  obtain  the  exact  values 
of  correlation  time  of  stochastic  variables  suoh  as  fluctuations  of  solar  pressure  or  of  low-thruet-englne  power. 
Therefore  It  Is  essential  to  carry  out  s  sensitivity  study  of  the  filter  ts  in  this  example. 
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CHAPTER  3  -  SUliOPT IU Al.  KALMAN  KILTER  TKCIINI RUES 

A.  R  . stuhberud  and  D.A.Wlamor 


1.  INTRODUCTION 

The  application  of  Kalman  filter  thoory1  require*  the  definition  of  a  linear  mathematical  model  deacribti.*  the 
system  for  which  tilt'  application  la  Intended.  In  many  cases  a  hliiMy  complex  model  must  to  used  to  accurately 
describe  tho  system.  Uaunlly  In  those  cases  only  a  few  of  the  ntntn  variation  are  of  primary  litercst,  the  lost 
merely  enhancing  the  description  of  the  ayatoin.  Since  tho  computational  burden  associated  with  the  Implementation 
of  a  Kalman  filter  Increases  aiKiUf  leant. ly  vKh  the  dlmenaion  of  the  syHtem  model,  denlgnern  are  motivated  to  seek 
simplifications  to  the  required  fl Kurins  nqun.loim  which  do  not  result  In  a  large  performance  degradation  In  the 
estimation  of  state  vootor  compononta  of  principal  interest.  The  ronulting  flltora  are  called  suhoptlmal  nltorn. 

On*  ■uoouaaful  technique  Investigated  by  Joseph3,  Moditoh*  and  Psn'cooet"  fer  simplifying  filter  oomputat Ions 
lnvolvoa  partitioning  the  state  vootor  Into  strongly  coupled  subsystems,  employing  Kalman's  optimal  filtering 
algorithm  for  the  atat*  vectors  cl  these  loaer-dimenslonal  systsme  and  reconstructing  *n  estimate  of  th*  original 
systtm  from  the  lowor-dlmensiona!  estimates.  Another  approach  introduced  by  Aokl ‘  and  Huddle*  and  related  to 
obaervsr  theory  of  Luenberger’,  employa  the  concept  of  linear  aggregation  of  states  to  achieve  a  oonolao  representa¬ 
tion  of  data,  thereby  reducing  tho  dimension  of  the  estimator.  Important  work  on  the  effects  on  the  Kalman  filter 
performance  of  error  In  th*  knowledge  of  ths  covariance  matrices  describing  the  initial  conditions  at  the  system 
stats  vector,  and  the  whits  observation  and  disturbance  notes  vectors  he*  been  contributed  by  llaffes*  and 
Nlihlmura11. 

Ths  techniques  for  generating  suboptimal  filters  can  be  roughly  divided  into  two  classes.  In  the  first,  the 
number  of  equations  defining  the  filter  la  the  same  su  fur  tho  optimal  filter,  but  the  number  of  equations  ncceacory 
for  oomuutlng  the  filter  gain  is  reduced  by  partitioning  ths  systsm.  In  the  sacund,  the  number  of  state  variables 
defining  the  filter  is  reduced  by  segregation,  This  also  reduces  th*  dimensionality  of  tho  oovarlanoa  matrix  and 
hence  rsduoaa  the  computation  required  to  generate  the  filter  gain. 

These  two  alsists  of  luhoptlmal  teohnlque*  are  dlaousaed  In  the  next  two  section*. 


2.  DISCRETE  TIME  SUBOPTIMAL  KILTERS  EMPLOYING  REDUCED 
FILTER  GAIN  COMPUTATION 

Thu  computet i'-nsl  burden  sssoolstsd  with  t  minimum  varieties,  unbiased  linear  filter  Is  strongly  dependent  on 
th*  number  of  simultaneous  difference  equations  which  define  tho  filter  end  the  filter  gain.  If  ths  stats  of  tn 
n-dla*n*lonal  system  is  being  sstlmr.tod,  a  total  of  u  difftrsnss  equation*  define  th*  filter  end  t  total  of 
n(n  ♦  l)/2  difference  equations  must  be  solvsd  to  detcreiin*  th*  optimal  filter  rain.  In  this  section  a  particular 
olass  of  suboptimal  filters  Is  dlsousssd.  The  property  of  these  filters  li>  tlirt  ths  order  of  the  equations  defining 
tba  filter  te  the  seme  at  thn  order  of  the  optimal  filter  but  the  number  of  eq.atione  ueod  to  calculate  the  filter 
gatn  1*  lsss  than  the  number  used  In  the  optimal  filter.  Hopefully,  the  total  number  of  equettone  orn  bo  reduced 
oonolderably  without  thu  performance  of  th*  filter  being  significantly  different  from  that  of  thd  optimal  filter. 

S,  1  Problem  Formulation 

Consider  s  dynamic  systea  defined  by  th*  linear  etoohastlc  difference  equation 

=  <6|,xk  +  uk  ,  k  *  0,  1,  2 .  (2,  1) 

where  >k  Is  th*  a*dim*n*lonal  -tst*  vector 

uk  Is  en  n-dlmenelonel  mere  mean  white  noise  sequence  with  covariance  matrix  QgSjg 
dig  it  the  own  diaenaianal  etate  transition  matrix 

x,  ,  th*  Initial  condition,  u  a  ssro  mean  random  variable,  independiut  of  uk  ,  with  covariance  matrix  P*  . 
The  system  1*  aeaumed  to  have  the  obeervabl*  output 

yk  =  Mkxk  +  vk  ,  (3.  'i ) 

where  yk  ie  the  m-dimeneional  obaervation  ysotor 
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Vjj  la  an  m-dlmona tonal  luro  mean  white  nolae  acqiiDiicv,  Independent  uf  both  uk  anti  x0  ,  with  covariance 
matrix  Rk8jk 

Vk  la  an  m«n  mntrlx  defining  m  linearly  Independent  obHervublo  combination!*  uf  tin)  atuto  vuriables. 

The  problem  la  to  generate  a  llnoar  ontlmntor  for  tho  stute  xk  whloh  mukos  uue  of  the  obuorvullimo  jj  ,  J  -  0 
1, ...  It  ,  to  generate  tho  estimate. 


Consider  the  clash  of  linear  unbiased  flltera  defined  by  the  ocochastle  illfferonco  equation 

^lt*t  =  *k*l  +  ^kM  ^k* :  ~^k*i^k«  J  '  (2.3) 

•hero  xk(1  la  defined  by 

*a.i  =  <\*k  .  (2  4) 

with  initial  condition  ig  *  0  .  Mure  ia  an  unblunod  eatlmatn  of  x^  and  In  an  arbitrary  n  <  01 

gain  matrix.  Tho  estimation  error  associated  with  thin  ontiirator  in  defined  as 

ek  r  xk  "  *k  (2. 

and  tho  oovarianci1  mntrlx  of  thin  wror  in  definod  bv 

Pk  =  EtSkfJ]  .  (2.6) 

This  matrix  (specifically  tho  elemonts  on  the  main  diagonal)  is  a  measure  of  the  of lectivoncns  of  tho  filter  and 
It  sstiafJeg  the  mntrlx  equations 

Pk.t  =  0kPk<f>I  +  Qk  (2.  T) 

Pk  =  Cl -KkMk]Pk(t -KkMk3T  ♦  KkRkKj  .  (2.8) 

•1th  the  Initial  condition  Pu  =  P*  .  where 

Pk  s  *[(xk-ik)(xk-Sk)T]  *  Et?k?j[]  .  (2.0) 

Note  that,  alnoe  !k  la  the  best  estimate  of  xk  baaed  on  ya  ,  y,, ..  yk>1  ,  It  Is  generally  a  poorer  eatlmito 

than  i!k  ,  «hlch  Includes  yk  also.  Pk  Is  thus  tho  true  measure  of  tho  filter  performance  and  Pk  Is  simply  sn 
intermediate  matrix  which  it  la  convenient  to  uarry  along.  Equations  (2.3)  and  (2.4)  *hloh  define  the  olasa  of 
unbiaaed  linear  flltera  are  valid  for  any  gain  Kk)il  ,  and  Equation!  (2.7)  and  (2.8)  define  the  variances  of  the 
errora  for  any  filter  having  this  fora.  Thus  the  effectiveness  of  auy  auboptimal  gain  oan  bo  evaluated  from  these 
general  variance  equations. 

A  special  member  of  this  olaaa  of  flltera  results  when  the  thin  is  chosen  aa 

*k.i  3  ^."k.itWk.l"!.!  +  *k.J'‘  •  (3.10) 

The  filter  la  than  m  minimum  variance  unbiased  filter.  In  this  oaaa  Equation  (2.8)  reduoea  to 

Pk  =  [l-KkMk}Pk  .  (2.8a) 

Tha  computational  burden  of  thla  optimal  flltar  Include*  the  solution  of  the  n  diffaranca  equation!  definod 
by  Equations  (2.3)  and  (2.4)  plua  the  solution  of  the  n(n  * l)/3  difference  aquations  defined  by  Equations  (2.7) 
end  (2.8)  to  oaloulmte  the  optimal  gain  Kk  (The  symmetry  of  the  a*  difference  equations  requires  that  only 
n(n+l)/2  nsed  to  be  aolvad. ) 

In  the  following  eub-geotions  some  mathode  1'or  ohooaing  auhoptlaal  gains  Kk>1  are  dlaeussed. 


1.1  Coaatant  (laina 

In  terms  of  a  reduction  in  computation,  an  obvioua  choice  for  Kk  ia  a  constant;  that  is, 

Kk  :  I  for  all  k  . 

Probably,  tha  most  common  oholut  of  a  constant  gain  la  tha  steady-ststa  value  (If  ana  exists)  of  the  optimal 
fain  matrix.  Conaldor  tha  oaaa  of  a  time-invariant  system,  that  is.  the  aeae  where 


\  =  M  ,  Qk  ~  Q  ,  R„  =  R  for  all  k  . 

Tha  ataady-atata  gain  for  this  system  (if  It  axiata)  la  determined  from  Equations  (2,7),  (2  8),  and  (2.10)  by 
sattint 


Pk  =  P,  Pk 

Tha  result  is  a  aat  of  aliebrlao  aquations 

P  = 

P  = 

K  = 


P  ,  Kk  =  K 


1  *» 


+  Q 

ti  -kwJpCx  -k«]t  •  krkt 

P«t  [mpm7  *  r]  ' 1  . 


for  all  k 


(2.  11) 
(2.  12) 
(2.  13) 


(2.  H) 


Tho. error -vai lance  equation  for  thin  cooo  becomes 

Pk(l  =  ri -KNl'/iP^tl  -  KM]  t  «  [I -KiOull -KH]t  r  KRKT 

It  should  bo  noted  that  tho  filler  gonei ated  In  thin  wuy  Is  the  classical  Wlenor  niter  fur  discrete  time  systems, 
whlcii  1b  euboptlmal  until  Btoudy-atuto  concUthmH  arc  rnachnd. 

2.3  A  Subop  1  Inal  Technique)  Rased  On  Partitioning 

In  thin  section  a  method  In  demonstrated  which  is  tinned  un  partitioning  of  tho  system  state  vector  into  snvnrnl 
sub-state  vectors.  The  states  of  tho  subsystems  thus  generated  iru  estimated  Individually  and  tho  reuniting 
estimates  arc  combined  linearly  to  generata  tho  total  estlmnto.  sinno  tho  number  of  variance  equations  varies 

approximately  as  tho  square  of  tho  dimension  of  the  system  state  the  number  of  variance  equations  used  to  compute 

tho  optimal  gains  is  significant ly  roducod. 

Consider  t  dynamic  system  duflnod  by  Equation  (2.1).  Joseph*  described  a  gonarul  method  for  partitioning  tho 
Statu  vector  of  the  system  lulu  a  net  of  1  subsystem  state  vactors.  Tho  1  subsystem  state  vectors  aru  doflned 

by  -j 

w‘k  '  DJxk  ■  J  =  1.  2,  . .  .  ,  1  ,  (2.  15) 

whore  Dj  Is  on  nj  *n  matrix  of  rank  iij  .  Thu  state  vector  xk  Is  recovered  from  tht  subsystem  state  vectors 

by  tho  relationship  ‘ 

’I  8  ^  Aj4  ~  ^  AjDJ*k  '  <2  1®> 

where  Aj  Is  an  a « nj  matrix. 

Suppose  the  stats  vsetor  xk  has  been  partitioned  Into  1  sub-utate  veotors 


e  l 

h  k  * 

fi.  •• 

'•k 

with  reipeotlvw  dimensions 

“i . 

n,  .  .. 

"  nt 

and  auppoas  that  individual  estimates 

*k  , 

il  . 

have  been  generated  from  tho  obeervatlons 

yi  , 

1  =0,1,. 

...  k. 

Then  the  eetimate  of  the  state  vector  Is  given  by 

*k  =  £  Ajfi  ■ 

Thle  eetimate  la  then  propagated  by  the  etate  transition  matrix,  thus  forming 

!k*i  =  "Mb  1 

The  propagated  aub-itate  estimate  of  ii  then  formed  by 

,-i‘i  =  °4ak<  t  ' 

Coneider  now  a  partitioning  of  the  observation  vector  defined  in  Equation  (2.2).  The  vector  yk 
into  i  ebeervation  vector* 

=  Ejyk  ,  j  =  i.  2 .  i  , 

where  Ej  ie  in  ijia  matrix.  The  eatimate  of  (f£, ,  ia  no*  updated  by  the  equation 

l*k*  1  1  ?k»i  ♦  Ek*iHLi“fliJ  ■  (2.21) 

where 

17i+i  “  ^*1  =  EjJrk»i  '  EJ^k*i 

s  EJ^k*i  "  EJMk*i*k+i 

=  Ej[»k*1*“k.likJ'  (2. 32) 


(2. 17) 

<2. 18) 

(2.19) 
is  partitioned 

(2.20) 


The  updated  state  oetiMte  Ip  than  given  by 

*k‘i  =  Aj*k»i 

"  ^  Aj*i* i  1 

=  *k,i  +  ^Lj  AJKi* tEJ  ^yk.  I '  Mk-l5k*  J  •  (2.  2») 

Comparing  Equations  (2.3)  and  (2.23),  It  la  apparent  that  this  represents  a  member  of  tho  dean  of  unbiased  flltera 
defined  by  Equation  (2.3),  Kero  tho  gain  la 


Kk..  =  jfc  vi.iEj  ■  «•») 

Note  that  Dj  ,  Aj  ,  ami  fcj  can  all  bo  undo  a  function  of  Che  time  Index  k  ao  that 

Kk.i  =  1*4..  ■ 

Thla  generalisation  allows  the  aubayatema  to  be  chanted  If  tha  ayatem  haa  several  modes  of  operation  which  make 
It  mandatory,  convenient,  or  more  effective  to  change  tho  ayatem  partltlone  for  the  several  nodes  of  operation. 

Equation  (2.23)  Indicates  that  the  individual  estimates  of  the  subsystem  states  need  not  be  generated.  It  la 
seen  that,  for  given  Aj  and  Ej  ,  only  the  K^tl  need  to  be  generated  and  then  KkM  can  be  generated  by 
equation  (2.24).  This  Kkjl  can  bo  uaed  directly  in  Equation  (2.23)  to  generate  tho  estimate  ft+1  . 


The  next  step  In  this  tnboptlaal  method  le  the  generation  of  the  aet  of  equations  used  to  compute  tho  gains 
Kj[  .  first,  an  arrow  equation  la  generated.  Subtracting  Equation  (2.4)  from  Equation  (2.1)  goneratea  the  error 
aquation 


*h.i 

= 

+  Uk  . 

(2.23) 

It  follows  lamtdlately  that 

*4.i 

= 

^♦1-14.1  =  °J*k»i  ~  DJ*k»i 

s 

DJ*k*i  =  cA^k  +  DJuk  ■ 

(2.26) 

Now 

H 

= 

Dj?k  . 

(2.27) 

1 

and  therefore 

*t 

« 

®i«4  *  *  • 

(2.  28) 

where  a  la  a  vector  In  tha  null  space  of  Dj  and  Dj  is  tha  pseudo- inverse  of  Uj  . 


If  Dj  has  maximal  rank,  than 

Dj  =  DjiDjDj)'1  (2.2D) 

la  a  suitable  peeudo- Inverse- 

Substituting  Equation  (2,23)  Into  Equation  (2.23)  yields 

«i.i  =  dAdjH +  DA*  +  Djuk 

=  >  DA*  ♦  DjUk  ,  (2.30) 

■bare  =  D,<f^D]  .  (2.31) 

At  thle  point  an  approximation  la  made.  It  la  assumed  that  the  nubsyeteae  are  uncoupled.  This  allows  the  gains  . 
for  each  subsystem  to  be  calculated  Individually.  The  absence  of  coupling  between  the  subsystems  implies  that 
■  S  0  .  la  general  tbla  la  not  trux  and  the  resulting  gains  are  auboptimml.  Under  this  assumption  Equation  (2.30) 

becomes 

*L  =  <2-22> 

A  variance  equation  la  now  generated  from  Equation  (2.32)  as 

■»4*»P'4..>T1  =  ^■®4«i)t]«#4>T  ♦  DjEtu^uj] Dj . 


(2.  33) 


..*■  .' 

.'-«•■  ,v  •• 


Now  consider  the  error  aquation 


Subitituting  from  Equation  (2.211 


Now  define 

=  E[?i(?i(ti)T)  (2.34) 

pi  =  i(aii*i>Tl  (2.35) 

and  Equation  (3.33)  becomci 

pi»i  =  *iPi(*i)T  ♦  .  (2. 3o> 

where 

«i  =  Dj  QkD j  .  (3.37) 

Now  consider  the  error  wquation 

*4.1  =  ^.1  -£'{.!  •  <=-3B) 

Subitituting  from  Equation  (2.21) 

Zi* i  =  *{»i  ”  ^i«i  - 

=  *i»i  “  Ki*iEEjPut“EJ^k*J 

=  2i*l  *  Si.|tej“nwi*li.i  +  EJvk-n'EJMk<i*k*^ 

“  *4*1  -»iel£*i“kel*kel  +  VkJ  •  <2'3B> 

Since 

*1,  =  °j>k»i  •  (2.40) 

then 

*fl  *  ♦  »i  •'  (2.41) 

when  >i  la  la  the  null  apace  of  Dj  .  Again  the  coupling  it  ignored  by  teeming  1^  =  0.  Equation  (2.38) 
becoaea 

J{*1  «  h-Kiel^kunJ^iwl-KielVkel  •  «.42> 

The  corresponding  varinnee  equation  la  given  by 

MUtU'l  -  *L 

s  Ex  - Ki. xt^ Pi, ,[l  - *i+ tEjMk* .Oj] T  ♦  Ki+lSjKktlBj(Ki+1)T  ,  (3.43) 

with  Initial  oonditloa  PJ0  =  DjP0d]  whan  Pg  =  E[x0xjj  .  Tha  gain  whioh  minimizes  Pj.,  it  then  given  hy 

Ei*i  =  T v^i* a(l*i» l)*  +  Ei*i^  *  •  (2.44) 

where 

"in  =  Bj“k*iDj  (2.45) 

Ki»l  =  EjRk*i*'I  ’  (2.48) 

The  baalo  equatlona  for  generating  XL,  are  Equation*  (2.36),  (2.43)  and  (2.44).  Having  calculated  , 

i  =  1,  2 . 1  .  the  total  gain  is  calculated  from  Equation  (2.34)  and  the  estimate  of  xk  la  given  by  the 

difference  aquation  (2.23). 

At  a  simple  example  whioh  Illustrates  only  the  computational  advantage!  of  tbla  method,  oonaldor  the  caae  of 
a  ayatea  atate  with  nine  atatfe  variable*  (n =8)  and  auppowe  it  haa  bean  partltionad  Into  throe  eubayatema,  each 
•1th  thre*  atatw  variables.  The  opt  loci  filter  require!  tha  solution  of  a  total  of  (8)(10)/2  =  45  simultaneous 
varianos  equatlona.  Tha  auboptlmal  filter  requires  the  solution  or  3[(3)(4)/2]  =  18  slmultaneoue  equations. 

Obviously  there  la  no  unique  obolce  for  the  partition  of  a  specific  system.  Pentecost*  discusses  a  rstionsle 
tor  partitioning  a  system. 

One  general  rule  for  partitioning  a  ayaten  Is  that  each  atate  variable  should  be  assigned,  through  a  choice 
of  the  matrices  Dj  ,  to  a  subsystem  which  secures  it  is  strongly  corrulsted  to  an  observation.  Heurlstically, 
using  a  auboptlmal  filter  1*  equivalent  to  making  the  system  leas  observable.  The  correlation  between  a  atate 
and  tha  observations  lo  a  measure  of  the  observability  of  the  atate  and  should  be  kept  es  large  as  possible  when 
choosing  a  partition.  Several  observations  will  generally  be  asaoclated  with  a  single  subsystem. 

A  ewcond  partitioning  rule  is  that  strongly  correlated  atntee  should  be  assigned  to  tbs  east  subsystem  since, 
in  a  general  partition,  the  correlation  between  states  in  different  subsystems  is  not  taken  into  account.  Any 
partition  should  be  chosen  to  minimize  this  loss  of  correlation.  One  measure  of  the  correlations  between  state 
variables  oan  be  obtained  from  the  error  covariance  Pk  for  the  optimal  filter.  The  correlation  matrix  Ck  with 
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°1J  =  J  ■  (2.47) 

where  Pjj  1»  an  element  o f  Pk  .  Tha  terms  cjfj  ,  1  /  J  balm  t  measure  of  atata  variable  correlation,  can  be 
used  to  group  atata  varlabloa  Into  the  aanu  aubayaten.  Noto  that  it  is  poauibla  that  one  atato  variable  wil'l 
belong  to  Dora  than  one  subsystem. 

In  order  to  proporly  daaign  a  auboptinal  flUar  na  doaaribed  in  this  section,  it  is  appropriate  to  porform  a 
full  aoalo  simulation  of  tha  optimal  filter  covariance  equations  and  suboplimal  filter  covartanco  equations 
Iterating  on  tha  choice  of  aubsystems  should  lead  to  a  suitable  filter  design.  In  most  aerospace  applications 
extensive  simulations  are  usually  tho  rule;  thersfure  this  technique  la  well  suited  to  those  applications. 
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3.  SUBOPTIMAL  FILTERS  EMPLOYING  STATE  REDUCTION 

An  altarnata  approach  to  that  oltcd  in  Section  2  assumes  that  unavoidable  errors  will  occur  in  the  formulation 
of  a  mathematical  modal  of  tho  system.  With  thin  premise,  a  primary  system  model  is  formulated  Including  only 
those  etate  vector  components  of  dominant  special  interest  to  ths  designer.  The  other  components  and  their 
interact  ion*  are  considered  as  part  of  a  secondary  subsystem.  When  this  is  dons,  the  stats  veotor  of  interest 
has  reduced  dimension  and  allows  a  rsduotion  in  ths  computational  burden  required  for  implementing  a  Kalman  filter 
based  on  the  primary  system  model.  In  many  prsotlcal  problems’'11  the  structure  of  the  plant  Is  suoh  that  the 
tuts  veotor  components  whloh  are  ignored  by  tueh  a  procedure  art  independent  sources  of  correlated  disturbance 
or  additive  observation  noise,  Thus,  the  eeoondery  eystem  may  he  considered  to  be  a  model  of  colored  nolle  In 
addition  to  the  ueuel  white  nolle  eouroee  assumed  in  the  primary  eubeyetem.  Thie  section  coneidern  tho  performance 
degradation  lnourred  by  baaing  the  filter  design  on  the  primary  eyetem  only.  The  natrlx  differential  equation 
governing  the  error  In  the  coverianoe  matrix  of  the  primary  eyetem  is  sxpreuied  explicitly  in  terme  of  the 
neglested  etate  components,  l.e.  the  secondary  aystes.  The  expression  for  performance  loss  incurred  with  any 
proposed  filter  allows  the  designer  to  determine  directly  the  utility  of  simple  models  In  filter  synthesis.  Error 
■odele  of  tLle  type  have  been  discussed  extensively  by  Larson l\ 

3.1  Problem  Formulation 

Consider  e  dynamic  system  which  can  be  represented  by  two  linear  stochastic  dlfferenoe  equations  of  the  form 

*tv»  -  Vi  ♦  vi  +  ui  <31> 

*i»l  =  AkXk  +  Uk  i  (3.3) 

where 

x£  is  an  n^dimintloanl  state  vector  oompoeed  of  those  components  of  *  refined  llnser  mathematical  model 
which  ere  dominant  or  of  epoolal  interest  (the  state  of  the  primary  eubeystem) . 

xj  is  an  n]-dlmennional  vector  oompoeed  of  those  eyetem  components  which  appear  am  time-correlated 

dleturbinoai  or  additive  observation  noise  in  e  refined  model  (the  state  of  the  secondary  eubeyetem) 

uk  is  an  n ^dimensional  zero-mean  white  nolee  sequence  with  covaritnee  matrix  ak5jk 

uj  it  an  n, -dimensional  zero-mean  white  nolee  sequence  with  covariance  matrix  QkSJk 

is  the  state  transition  matrix  for  the  primary  eubeyetem,  en  n^n,  dimension  matrix 

Ck  le  a  matrix  whioh  couples  the  effect  of  the  enoondary  state  veotor  into  the  primary  system,  an  Ojxn, 
dimensional  natrlx 

(V*  le  the  etate  transition  matrix  fer  the  secondary  eubeyetem,  an  n,  m,.  dimensional  matrix. 

Tbs  eyetem  It  asswed  to  bave  the  observable  outputs 

yk  =  llkxk  +  vk  ,  (3.3) 

where 

yk  Is  an  a-dimennionil  observation  veotor 

vk  it  an  m-dimeneional  sero-naan  white  nolae  sequence  whioh  is  Independent  of  uk  and  uk  and  bae 
oovaritnee  matrix  Rk5Jk 

xk  lean  n  ”  (nl  +n,)-dlmen«lonal  vector  composed  of  xk  and  xk 

■k  =  [Mlk  :  Ma  k)  lean  mxn  dimensional  matrix  defining  s  linearly  lndepeadent  cbiervmble  oombinmtlane 
of  system  atata  variables.  Htk  la  an  mxn,  dimemlonal  matrix  and  H,k  la  an  mxn,  dimensional 
matrix. 

To  raduot  computational  requlreaenta  for  implementing  an  estimate  of  the  primary  subsystem  state  vector  xk  , 
the  filter  design  is  based  on  the  simplified  model 

V.  =  Vu  *  \  <34>  • 

y„  =  «lk*k  +  7k.  (3.5) 
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lt  1*  in  n;-dlMnalonol  atate  vac  tor 
yk  la  an  m-diaanalonal  obaarvatlon  victor 

Hk  li  in  n,-dlman*ional  ziro-niM  whita  nolle  aiquanca  with  oovirlinci  Qk5jk 
Vk  ll  in  ■-dlBOOllonll  zero-main  white  nolsa  laquonee  with  oovirlmoi  matrix  (iSJk 

It  ii  now  ot  lntirnt  to  detariilne  tho  error  of  the  estimate  of  the  itite  xk  where  the  Kalman  filtering  ilgorithn 
li  applied  to  the  ileplifled  godel  dofined  by  Equation*  (3,4)  end  (3.9). 


In  order  to  cilculite  the  performnee  Ion  from  optimal  Incurred  by  thii  amplification,  we  could  compute  the 
optimal  eitlmate  end  compare  it  with  the  eitimato  bated  on  tho  ilmpllfied  model.  However  tho  optimal  eitlmite 
requlree  the  lolutlon  of  in  nan  dlmeniloml  matrix  Kicittl  equation  whioh  we  wanted  to  avoid  by  uiing  the 
■uboptlmil  approach.  It  Is  poailbla  to  ditermlno  a  portion  of  the  porforminoe  degradation  with  llttlo  additional 
computation.  Thin  portion  la  tho  effect  of  the  aooondery  atate  variable*  on  the  estlmatt  when  the  euboptlmal  Kalman 
gain  in  uaed.  Although  thle  is  not  the  tote»  performance  loas  due  to  the  auboptlmal  eetlmatlon  It  dooe  give  an 
Indication  of  thle  affect. 


The  linear  filttr  for  the  entire  oyitem  le  given  by 

*k*t  *  Ak*k  +  ^k^k”**A^ 


where 


=  r&x°k. 
L°  i^J 


Kk  a  lain  n*m  arbitrary  gain  matrix,  Klk 

Ltol 

being  n,xm  dlmeniloml  and  K]k 
being  nf  k  a  dlmanalonal. 


(3.8) 


If  .tha.damlgaar.MiUMa  tha  mlapUfltd  foxm  of  tbo  plant  ,aa  a  basla  for  aynthaalalng  a  filter  for  the  itite  veotor 
nomponenti  that  art  of  primary  lntaraat,  tha  gain  matrix  haaoaaa 


Now  dmflnlng  tha  error  of  tha  aatlmata  aa 

and 


«i  «  *i-*k 
xj-tj 


wl  .  .1  .  (t 

*g  -  *k 


<3.T) 


at  oin  determine  tha  oovarlanca  matrix  for  tha  filter.  However,  ainoa  tha  filttr  gain  la  baaed  on  tha  primary 
lyatam  only,  tk  »  0  and  Ik  =  xj  .  Tbua,  by  appropriate  aubaltution  into  (3.7),  va  gat 


*k*l  *  ^"*lk*ik^*k  +  Ck  f  Sk  +  uk  -  Klkvk  . 


(3.8) 


where 


5W  m  0„ 


*it**»k 


Tha  oovarlanca  matrix  for  the  overall  ayatam  can  now  ha  arlttan  in  tcraa  of  tha  subayktam  alamanta.  Defining 

p\i  =  '([(*1) «{)*]  , 

wbart  tha  dlaanalor.a  of  p*,.  ,  pj,  ,  p\l  art  raapaotlvaly  ,  n,  «n,  ,  and  ntxnt  and  wbara  a  ^fi>T 

Performing  tha  Indicated  operation!  yieidi 

*w‘  3  B*°uBk  ♦  Bk^w®g  +®k^aiBk  *  ^Ja^k  ♦  ®k  +  ^ibVlk 


abara 


'’ii1  3  Vu^k  + 

ft1  3  VM  ♦  . 

»k  3  *k  -  *lk"»k 


<3, 9a) 
(3.  Bb) 
(3.8c) 


Noti  that  tha  nature  of  tha  coupling  between  pjj1  ,  pjj 1  ,  and  p\\x  parmlta  tha  axpllolt  aolution  for  tach  of 
thaaa  aatrioaa  In  a  aerial  aacsar. 

In  order  to  avaluata  tha  dtgradatlon  in  performance  due  to  the  affaot-nf  tha  aaoondary  aubayitim,  it  la  necessary 
to  dataralna  tha  oovarlanca  aatrix  baaed  on  the  alapllfiad  model.  Thle  '.n  uaally  detarainad  from  Pj* 1  by  aattlng 
Sk  to  xero.  Daflsini 

Pk  *  lC(lk)(!k)]  . 


*•  attain  the  recurrence  relstlon  t or  ths  simplified  system  u 

pk*‘  =  BkpkBj  +  5k  +  K,kRkK*k  .  (3, 10) 

Now  defining  the  error  lntroduoed  into  the  primary  subey'atcm  by  the  eeoondery  subsystem  ae 

Eh  s  Pn  -Pi- 

ylelde  t  recurrence  oeloulntlon  for  the  error  matrix;  ntnely 

®k*i  *  BkEkBj  +  Bkpk,Cj  +  Ckp![|Bj  +  2kp},cJ  +  AQk  +  ,  (3.  11) 

where 

AQk  =  Qk  -  \ 

ARk.  a  Rk  ■  Rk  i 

end  where  the  natriooe  pk,  end  p\ ,  ere  obtained  recursively  at  above.  Tho  AQk  end  ARk  matrices  represent 
the  error  in  modming  the  white  noise  aoquences  for  the  a  imp  lifted  system.  Thus  the  error  matrix  Ek  can  be 
oaaputed  simultaneously  with  tho  simplified  filter  equations  in  order  to  indicate  the  error  incurred  by  omitting 
the  secondary  subsystem  variables  from  the  primary  model. 

The  above  analysis  holds  for  any  arbitrary  gain  matrix  Klk  .  However  if  the  optimal  Kalman  filter  is  employed, 
the  gain  matrix  is  ohossn  as 

*ik  *  /Mk£"lk0*ik+y-‘  •  (3.13) 


3.1  Results  for  the  Continuous  Cass 

In  the  cass  where  the  system  is  dasorlbsd  by  linear  differential  equations  instead  of  differsnoe  equations 
similar  results  are  obtained.  Thus  if  the  system  is  given  as 


it  a  A(t)*j  +  C(t)x,  +  u  i 
*j  *  A(t)xk  +  u, 
y(t)  «  B<t)x(t)  +  v(t>  , 


(3. 13) 


where  the  veatars  end  mstrioss  are  defined  to  be  analogous  to  tbs  dlsorsts  out  sad  if  the  simplified  system  is 
given  by 

*<t) 


J<t) 

tbs  corresponding  oovsrlsnos  equations  ere 

*ii 

PX1 


Aj(t)I(t)  +  Uj 
Bj(t)I(t)  +  v  , 


where 


=  BPU  +  pnBr  +  Cpfl  +  P„CT  >  Qi  d  KjIWj 
3  B°n  +  ®*n  ♦  Pl8AT 
*ii  E  A/=„  +  P„  AT  *  Qj  , 

B  *  A,(t)  -  K|(t)M1(t) 

8  a  C<t)  -  K((t)Nt(t)  . 


(3. 14) 

(3. 15a) 
(3. 15b) 
(3. 15o) 


■lmllarly  tbs  covarlanos  matrix  for  the  simplified  aystsi  is  given  by 

P  »  BP  +  pBT  +  q  *  K,RK*  . 


(3.  15) 


la  this  osss  the  differential  equation  dsaoribing  tbs  degradation  in  tbs  system  performance  due  to  the  existence 
of  unmodslsd  state  varisblss  is  given  by 

■  a  BE  +  BB1  +  CPjj  +  pitV  +  A«  +  KtARK)  ,  (3. 17) 

■hers 

1(0)  a  pu(0)  -  p(0)  . 

which  equals  atro  if  tbs  initial  ooadlUoni  for  thaaa  covarlancs  matrices  colnolds.  In  the  continuous  csss  tha 
optimal  estimate  based  on  the  simplified  model  is  implemented  when  tbs  gain  matrix  is  ohossn  as 

E,  a  pd*R-‘  . 


3.1  Tbs  Stasdy-sr.ite  Csss 


An  snslytio  closed  form  expression  tor  ths  steady-stats  values  of  performance  loss  cm  be  obtained  dlrsctly 
from  the  above  differential  aquations.  Temporarily  asaumlng  that  ths  design  oorrsipondlng  to  the  aimplifisd  model 


io  atable,  thrve  nutria  equation*  are  obtained  by  getting 

*  '  *at  -•  ^i»  =  0  • 

Deploying  the  well-known  lolution  of  then  equal  lone1’,  the  following  ccauf.nce  of  e’prenctonn  per  mile  the  determine- 
tlon  of  the  eteedy-etet*  performance  loee  E  due  ta  tlio  modeling  errore. 


o,,  s  J^explAt'cij  expfArt]  dt 
Plt  =  J^expiBtlSp^eapfA’t]  dt 
E  =  J  oxptet]  [C/ojj  +  K^ARX^  +  AQ  +  plaST]exp[BTt]  dt 


3.4  The  Cue  of  Randan  Sealing 

In  many  eppllcetlone  of  Kalman  filtering,  the  filter  etetes  are  updeted  randomly  in  tine.  This  eituetlon  nay 
be  oeueed  by  oonputetionel  allocation  in  the  ayeten  computer,  eubiyotem  nalfunotione,  or  when  aguurementa  aro 
aade  aperiodioally *" l5.  The  "optimal"  gain  for  thia  type  of  filter  ie  aero  exoept  at  the  update  time  when  It  ia 
given  by 

Up  a  +  R}'1  . 

Tbla  le  nearly  the  hm  optimal  gain  aa  the  dlaorete  tine  filter,  aioept  that  in  thia  oaae  the  covariance  aatrlcea 
are  propagated  by  the  following  differential  equationa  obtained  by  aetting  Kt  *  0  in  (3.1(b)  (3.15c)  and  (3.17) 
for  the  oontlnuoua  caae.  Thua,  between  the  random  update  tinea,  we  have 

<  a  BE  +  is’  +  Cpu  *  iOtlC*  +  AQ  (3. 19a) 

Ae  “  >3>t»  ♦ /»i»AT  ♦  CJ°„  (3.19b) 

All  *  A/3„  +  p„ AT  +  «,  .  (3. 100) 

At  the  tine  an  update  in  the  eetlmated  atate  of  the  plant  oooura,  the  old  value  tj  (a  priori  eetlmete)  ia  replaced 
by  a  new  value  1|  (n  pomriorl  eatlnate).  The  a  potttriori  eetlmete  la  obtained  ae 

t\  a  +K1[H1xl+v  +  Btll-lliri]  .  (3.30) 

Since  no  eatlute  of  the  atate  vector  g,  le  generated. 

Ij  s  IJ  *  0  . 


Defining  the  inetentaneoue  eetimatlon  errore  aa 


*: .  Bg-tj 

rl  *  *1  -  *‘l 
*t  "  «!• 


k*t  a  t\  +  Kib(|Zj  +  B,XJ  +  »]  (3.31) 

mi;.  (3.22) 

Uelng  theae  expreeeione  we  can  obtain  expreeelona  for  updating  the  oovarianoe  matrloee  oorreapondlng  to  the  a  priori 
end  a  poeteriori  eetlmatee  in  a  atraightforward  manner.  Thue,  defining 

p\y  n  c[<lj)  (!*)»] 

and  Pjj  ■  l((IJ)(IJ)T] 

yielde 

pj,  a  [l-K,«l]p-u[l.  Kll|,]1  ♦  BjBK*  ♦  [*,*,]/»;  JX-Ep*,]*'- 

*  [l-KlNl]p*ll(ltll(,]T  +  [«,*,]/>;,&(,«,]»  (3.23a) 

f>\t  ■  tl +EiH|A>;,  (3.33b) 


where  I  la  the  Identity  matrix  of  dlaeneion  n,  . 

The  oorreapondlng  equation  for  updating  the  oovarianoe  aatrix  of  the  elapllfled  ayeten  it 

P*  a  Cl -ICjM,]/)-  Cl -KlMl3T  +  K^K*  . 


(3.24) 


rinally  tho  •quation  for  updating  the  performance  loan  defined  me 

E  5  Pu  -  P 

is  obtained  fron  (3  !3a)  and  (3.24)  at 

fc*  »  (l -KjM.iK'a -*,«,)»  ♦  K/RK*  +  tKjMjlpj,!)  +  [l -K1M1]p;t[KlMJ]1  +  [X^lp^K •  (3- 2B) 

4.  CONCLUSIONS 

In  this  ohapter  the  luboptimal  filtering  problem  Is  disoueued.  Roughly,  tho  luboptimal  filtering  techniques 
can  bo  broken  Into  two  jonoral  oategorlee.  Tho  first  category  has  the  property  that  the  order  of  tho  luboptimal 
filter  is  the  ansa  as  that  of  the  optimal  filter,  but  tho  number  of  oquationi  neoeaaary  to  generate  the  filter 
gain  la  reduced.  One  way  of  performing  thla  reduction  la  by  partitioning  tbt  aystan  and  ignoring  any  correlation 
which  exists  between  tho  various  subsystems  thus  formed.  Generally  an  ertenilve  simulation  la  necessary  to  minimise 
the  degradation  In  filter  performance  caused  by  the  suboptlmallty.  The  savings  in  computation  oan,  however,  bo 
very  eubetentiel  if  the  system  can  bo  finely  partitioned. 

The  second  category  of  luboptimal  filters  has  the  property  that  the  filter  design  is  based  on  a  lower  dimensional 
state  veotor  than  the  higher  dimensional  model  which  defines  the  systom  state.  As  a  result  the  number  of  covariance 
vquetloni  Is  also  reduced.  An  estimate  of  the  test  important  element*  of  the  higher  dimensional  model  can  be 
obtained  along  with  a  differential  aquation  describing  tho  performance  lomm  incurred  by  tho  model  slmrllfiomtlon. 

The  filtering  and  performance  Ion  equations  oan  be  solved  elmultareouely  to  obtain  an  indication  of  aotual 
performance. 
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CHAPTER  8  -  COMPARISON  OP  KALMAN,  BAYESIAN  AND  MAXIMUM  LIKELIHOOD 
ESTIMATION  TECHNIQUES 
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PRECEDING  MCE  BLANK 


CHAPTER  I  -  COMPARISON  OP  KALMAN.  BAYESIAN  AND  MAXIMUM  LIKELIHOOD 
ESTIMATION  TECHNIQUES 

H.W.  Sortition 


1.  PROBABILISTIC  approaches  to  estimation  theory 

Thin  tri  aany  different  approaches  to  thi  infirmtUl  problem  of  estimating  parameters  or  states  from  obairvid 
date.  Sou  of  then  have  bain  dinouiiid  In  othar  nhaptorB  (e  g..  Chapter  1).  In  tbla  ahapter  the  problem  la 
approaohid  by  dealing  with  the  probability  danalty  functions  describing  the  atate  and  maanurimant  variables. 

Thle  general  probabilistic  formulation  la  referred  to  aa  tha  Bayesian  approach*'3  and  It  proviUei  i  framework 
within  which  many  othar  approachoe  oan  bo  aubiuned.  ueing  the  Bnyoelun  formulation,  one  arrives  naturally  at 
the  asRlaua  o  pot (trior i  and  atximum  likelihood  eatiaatlon  procedure**,  It  la  also  tun  that  deUrminlatln  least* 
aquaria  oan  be  reinterpreted  ae  maximum  a  poeiirlort  eatination  theory,  In  Chapter  l  tha  Kalaan  filter  aquations 
have  bean  darlvad  U  the  solution  of  tha  unbiaaed,  minimum  variance  estimation  problem,  It  la  pointed  out  here 
thst  the  ilniaua  variance  criterion  le  Juet  one  of  aany  that  eould  be  ohoeen  whiob  all  yield  the  same  ultimata 
for  linear,  gauaalan  ayatema, 

The  eatination  problea  for  tleie-dieorete,  nonlinear,  stochastic  wateaa  la  formulated  In  Saotlon  1,3.  Within 
the  Bayeeiafl  framework  a  saneral  treatment  of  nonlinear  systems  pan  be  developed  In  a  straightforward  aannar. 

Aa  indlcntad  In  Sections  2  and  3,  It  la  naoeaaary  to  introduce  additional  restrictions  in  order  to  obtain  practical 
solutions,  but  It  la  felt  that  tha  (antral  formulation  and  subsequent  simplifications  provide  desirable  insights 
into  the  nonlinear  sal last Ion  problem. 

1. 1  Detaratniatio  Leoat-iquarei  Estimation 

Aa  a  preliminary  to  the  probebllietio  dlsoueeion  of  litigation  theory  that  la  found  in  Mentions  2  and  3,  tha 
problem  of  eatlaatlng  paraaatera  or  atataa  from  aeanuroeont  data  la  first  traatad  mine  deterministic  leeit- 
aquaraa.  Thii  foraUlation  loads  to  a  alnlmliatiou  problem  whose  solution  la  nontrivial.  It  la  polntod  out  in 
(Motion  1  that  tha  dotaralnlatlo  laaat-squaraa  approach  is  aqulvalent  to  the  Maxiaum  a  pot ttriori  approach  when 
tha  appropriate  aasuaptlona  are  introduced. 

To  simplify  tha  dlaouailon,  first  oooaidur  tho  problem  of  estimating  on  unknown  parameter  j  from  meaiuremant 
data  |,<1«  1,3,,,  ,N)  ,  ehora  the  oollectlon  of  date  will  be  denoted  aa  .  suppose  that  tha  data  ZN  era 
obtained  at  dlaorata  instants  of  time  tt(l « 1, 3, . . , ,N)  and  that  tha  Rt  la  an  a-dlmenalonal  vactnr  representing 
■  Independent  auaaureaents.  Then  data  oontaln  unknown  error*  It  and  art  ralated  to  the  parametera  according  to 

la  »  h4<*)  ♦  la :  i  ■  I.  a, .  n  .  a  i) 

where  the  ha  **•  lu,0'm  functioue  of  the  n-dlmeaalonal  vactcr  of  paraaatar  J  , 

la  the  classical  leael-iquurie  procedure,  une  treat*  (1.  1)  in  i  dsterainliUo  fashion  and  finds  tha  value  of 
I  that  alnlilaes  tha  aua  of  tha  squares  of  the  error,  for  example,  combine  the  N  measurement  vector*  Into  on* 
nN  veotor  (or,  euppcee  N*  1)  and  denote  it  aa 

2n  -  a<l)  +  J!  -  (l.a> 

•hare  ,  tl  ud  1  have  obvious  definitions.  Then,  ehooee  tha  j  so  that 

h  «  !»*-&(«>)  (1.3) 

la  alnlmlaed.  Since  there  are  no  othar  constraints,  a  necessary  ccndltion  for  L  to  be  aiolalaad  la* 


•  The  following  convention  Is  uetd,  Thv  partial  derivative  at  a  analar  function  h  of  an  n-dirtneioeal  vector  varltble  j 


le  denoted  by  3b/3i  and  lea  Ixn  aatrli  wboee  elemente  are  3h/3i,  ,  oh/3j,  .  3b/3jn  ,  If  in  a-UUMnulonil  vector 

function  h  le  dlfferertliled,  then  3p/3|  lean  an  satri*  with  tb*  ljth  e  latent  equal  tu  3h(,;3ij  .  Al«o,  the 
second  derivative  of  eioaler  function  h  le  written  n*  3/(3 h/3j)T/3»  ,  and  la  >n  nxn  aatrli  wboee  ljlh  element  le 
3,b/3xJ3*l  , 


Bnrw 


s:* 


‘»v;v,s; 


It  ii  not  generally  roMihlv  to  eolve  (M)  #x|il loitly  for  j  .  Howcvor,  it  (1.3)  In  linusr  «o  that 


Z,  e  HX  4  * 


•her*  H  in  in  uNin  matrix,  thin 


lo  thit  (1.4)  beoomii 


<HtH)X  s  h%  , 


Donotlni  *.ht  solution  of  (1.0)  by  {  ,  thi  leaet-equnree  intimate,  lupponlm  thit  (tlTH)  han  in  inveree,  Is  men 
to  lx 

1,  «  (HtH)-‘  H%  .  (1.7) 

Obierve  In  (1.7)  thit  in  n«n  mutrlx  mint  ba  Inverted  and  that  all  of  the  neniiurenuint  dnt»  nrd  prooeimod.  Tim 
positivo-def lnltonoee  of  (llTH)  in  equivalent  to  the  observability  of  the  systom  (l.B)  an  Introduced  In  Ctmptcr  1. 
It  ll  poiuuble  to  generate  least-squares  ost.lmates  recursively  ns  new  date  are  obtained  and  thereby  avoid 
reprocessing  uld  data*. 

Suppose  lk.,  li  tin  utinato  ct  j  bated  on  tho  data  Xl  gk_,  .  Let  Zk-l  denote  the  aet  of 

all  these  data  and  auppoae  that  new  data  sk  are  obtained,  Let 


Note  that  (1,1)  ie  ldentleal  with  (1,3),  aioept  that  the  individual  tuplee  are  written  explicitly  and  the  lyiten 
la  aeeuned'to  be  deeorlbed  by  a  linear  verilon  of  (1.1). 


L|  «  4-  %  -  Hkj] T  [|k  -  Hkg] 

•  1-k.i  +  Clk-Hk»]Tt|k-Hk*]  . 

To  detsmlns  the  estimate  that  minlmiass  Lk  ,  form 


^  *  o  ■  ~  a  ife  +  a  xTHjHk 


or,  lining 


thl*  oondltlon  baocaaa 


TLui,  one  obtalua 


-  a<Sk-,)V-‘  +  4{(Hll',)TMk'1  -  3«jHk  +  JljHillg  *  0, 

l{[(Hh-‘)TH*‘-1  +  HjHk]  e  (8k.j)THk-1  +|jHk 

»  lg.i(Hl,"l)*Hk'1  +  JkHk  . 


Qulded  by  the  Intuition  provldtd  by  Chapter  1,  let 


Tben  (19)  beoomee 


p;1  S  (Hk)V  . 


p;‘ik  s  pkijk-i  +  HI*k  ■ 


■v  v.y.v-v.v.- 
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n,  .  Ui*t  l*|j 1  hti c  an  invop»».  obtain* 

V  s  Vk-'Jk-i  +  pkHI*ik  ■ 

But  it  lOllcwa,  using  the  Matrix  Inversion  L.  v  (sue  Section  3.1.4  of  Chaptur  1),  thst 

Vi! i  "  \li*»Wlpi!i 

1  1  -  rk- t,,u"1k*  a- -"T  +  ll*‘  Hk 
£  1  -  KkHk  , 

where  Kk  *  Pk.,llJ  [HkPk.,Hj  til-1  . 

As  shown  in  Chapter  1,  it  follows  thst 


V.V  ' 

*  •  "O'. 

■;  V.>v 

:\y.W/  V^'v,* 

V%»  *#*  /-  '*  .**  *'♦  • 

*  S  I  ,  "  ,  •  *.»*•,  t 


Hi 

nvV-V-V-V-V-V« 
■-V'-V- '.-AVO 


to  (1. ll)  reducos  to 

lk  =  Jk.,  t  ltktjEk -»vik- tJ  ■  a  13 

There  it  t  isnersliestlon  thst  la  particularly  useful.  Suppose  thst  sertsih  measurement  errors  sro  to  be 
liven  lore  weight  then  others.  Then,  the  cost  function  osn  be  written  si  a  weighted  loait-equarsi  sun, 


^|  s  ^  £|j  ■HjglRj'tjj -Hjg]  , 


It  follows,  by  forking  3Lk/3j  ,  thst 


^  °  +  3*THlRk‘Hk 


Thus,  the  weighting  astrii  Rkl  modifies  only  the  Mtrloes  Pk  snd  Kk  , 

Pk  «  tPiii+  H5»k‘«k]“  <1,15) 

end  Kk  «  [HkPk.,Hj[  +  «k]  * 1  (1.  IBs) 

*  PkHjHk*  .  <1.  ISb) 

Olesrly.  deterilnietio  least-square*  eitlistee  ere  closely  related  to  the  Kalian  filter  estiietee.  However, 
no  probabilietlo  interpretations  have  been  attesuited.  As  will  be  seen  below,  the  prablsn  osn  be  oouohed  in  s 
frees  work  thst  provides  s  probabilistic  interpretation  of  least  .-squares  ss  the  easium  a  posteriori  or  noet 
probabli  estimate. 

Thus  fir,  the  psrsuetsrs  a  have  been  treated  aa  constants,  Another  way  of  considering  these  parameters  it 
to  view  them  aa  state  variables  described  by  the  plant  equation 

Ik  a  lk-i  1 

The  exteneion  to  a  more  general  model  for  the  plant  la  not  especially  difficult.  Suppose  that  the  plant  is 
described  by 

*k  *  Ik^li-i)  *  *k-i  :  k  3  *•*••••  U.  H) 

and  the  lessurements  involve  only  the  current  state  1 

*k  a  Mia*  +  *k  ;  h  *  1,  3 .  M.  IB) 

Equation  <1.  IT)  representi  a  oonatraint  on  the  eyetei.  The  gk.1  repreeent  uncertainties  or  errors  in  the  model 
that  cannot  otherwita  be  accounted  for.  gk.k  will  be  considered  si  parameter*  that  ara  chosen  to  minimize  the 
eetlietlon  error. 

Coneider  the  problem  of  choosing  the  sequences  gk  end  Ik.,  to  minimise  the  moan-square  error 

La  1  It;‘  In-Mig)!  •  <>■») 
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subject  to  tho  constraint  (1.  17).  Tha  first  term  in  (1.  IS),  It  included  tn  account  tor  anno  Initial  estimate  of 
the  atata  ig  .  WeighUni  matrices  f'1  ,  RJl  ,  Qj 1  ara  Included  for  generality. 

Thia  discussion  hat  bean  Included  to  act  thn  atago  for  later  dlicusNlon.  As  ahould  bu  anticipated,  tho 
aolutlon  uf  thia  general  problem  la  difficult.  However,  whan  (1.17)  and  (1.18)  ere  linear,  one  obtains  the 
Kalman  filter  equatlona.  Thia  aapeot  in  dealt  with  again  in  Section  3.3. 

1.8  Ooneral  I'.atlmatlun  Problem  for  Tlmo  Dtacrcte  Stochastic 

System* 

It  ia  poBBlble  to  approach  the  Ununr  estimation  problem  in  a  variety  of  ways.  Too  often,  hoaevor,  the 
treatment  of  the  linoar  problem  does  not  Indicate  tho  manner  in  which  one  can  apply  tho  technique  to  nonlinear 
problems,  nor  are  the  difficulties  presented  by  nonllneur  systems  made  apparent.  It  Is  tho  Intent  In  this 
ohaptti  to  doscrlbo  a  p.onllnosr  estimation  problem  uml  to  discuss  two  of  the  methods  used  to  attack  this  problem. 
After  the  general  oharactor  of  Hie  approaches  Is  dcflnud,  the  discussion  Is  specialized  to  linoar  syntoitm  to 
obtain  the  Kalman  flltsr  equations.  Time-discrete  synloms  are  considered  in  order  to  simplify  tho  mathematlce 
and  thoreby  avoid  tlir  dlffloultlos  that  liuvo  led  to  the  development  of  tho  Btoohastlo  oalculusoB  of  Ito*  and  of 
Stratonovlch’  for  Umo-eontlliuouB  nyHtems. 

Conaldor  a  dynamloal  syhtom  dnsorlbed  by  a  non linoar  difference  equation  in  which  tho  etato  evolves  according 
to 

*k  *  Ik<*k-pSk-i>  ■  (1'29) 

The  atata  has  an  initial  atate  j0  which  la  a  random  varlabla  with  a  known  probability  donalty  function',  aay 
P(Xg)  ■  Tho  j  repreeanta  a  aamplo  of  a  random  sequence  with  known  probability  density  funotlon.  Throughout 

this  discussion,  It  Is  assumsd  that  tbe  w(  are  Independent  between  the  sampling  times  and,  thoraby,  constitute 
a  while-noiif  n queue*.  Thus 

P(Sj.  ftp  •  •  •  •  Sg)  a  P(*s)p(Ii)...p(Sg)  . 

The  atata  Is  obsarvsd  through  ralttrd  measurement  data  jk  described  by 

*k  3  Sk^k'ik5  1  k  ■  I.  3 .  d-2** 

Tha  Vg  rapresent  a  o ample  from  a  whlte-noiae  aequenoe  for  which  tha  probability  density  funotlon  la  known  and 
■given  5y 

P(yl.!£l . Xk>  =  P(Jti>P<X»>.  •  P<Xk>  • 

The  plant  and  measurement  nolle  sequences  sra  assumed  to  bt  independent  of  eaoh  other  and  of  the  Initial  atate. 

This  aeaumptlbn  could  be  eliminated  without  elgnlfioant  conceptual  difficulty  but  the  notatlob  baoomas  more 

complicated, 

The  filtering  problem*  of  eitlmntlng  Kg  from  measurement  data  Zg  fill  be  oonaldered  almost  exclusively. 

The  eoldtlon  of  ths  prediction  problem  le  a  trivial  reault.  As  shown  in  Chapter  1,  the  solution  of  the  smoothing 
problem  la  obtained  from  the  filterlm  eolutlon,  ao  It  is  not  discussed  hers. 

The  problem  has  besn  oast  in  s  probabilistic  mold  that  reflscts  the  uncertainty  In  the  dynamic  modal  and  the 
aeuuraments  tbat  commonly  exist  in  physical  ayatema.  Admittedly,  this  formulation  might  be  oonaidarad  to  bo 
artificial,  alnoa  ono  la  unlikely  to  have  a  good  knowledge  or  tha  density  functions  involved,  ao  the  uncertainties 
appear  to  have  been  compounded  by  their  Introduction.  Betting  tbit  objection  Slide,  it  will  be  teen  that  the 
olaeelosl  lenst-iquaree  approach  la  Imbedded  in  thie  formulation,  ao  that  one  does  not  obscure  the  problem  by 
theae  consideration!,  in  fact,  one  la  led  to  the  aonoluslon  that  the  leaat-aquarei  phllooophy  li  anrlohad  and 
deepened  by  raouatlng  th*  problem  in  thia  manner  and  that  new  insights  ara  obtained  thereby. 

The  Bayesian  approach  provldeu  the  theoretical  structure  within  which  a  variety  of  approaohaa  can  be  ooneldered. 
In  Beotion  2  the  general  raaulta  of  this  method  are  presented  and  tha  Kalman  filter  equatlona  art  derived.  The 
maximum  likelihood  and  maximum  a  poiterfarf  eatimation  procedures  are  discussed  in  Beotion  3.  Th*  Crsmsr-Rao 
insqusllty  is  discussed  and  ths  Fliher  information  matrix  ie  ralstad  to  the  error  covariance  matrix  of  the  Ktlmen 
filter. 


•  The  notation  that  1»  ue«!  follows  Pol'dbaua1  and  haa  tbe  disadvantage  that  tbe  argument  of  tbe  function  eerves  a  dual 
purpose,  ft  ie  ueed  to  name  the  functloo,  os  here,  and  la  alio  treated  as  a  variable  name  (e.g.,  It  le  treated  ta  tbe 
viriabla  of  integration).  Tb«  waning  ahouid  b«  olaar.froa  tha  oontaxt. 

♦  Tht  raadar  ia  diraotad  to  Chuptar  1  for  a  definition  of  the  taraa  rtlatlni  to  tha  different  aapaata  of  the  •ntlaatlon 
problti. 
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1.  THE  BAYESIAN  APPROACH 

In  tho  "Dnyoslan  approach"  to  tht  filtering  problem  one  in  concerned  first  nf  all  wltli  the  determination  of 
the  u  posteriori  density  function  p(jk!2|,) .  This  donHlty.  function  provides  sll  tho  Information  required  for 
tho  solution  of  this  problem.  This  statement  *111  bo  discussed  in  more  detail  below.  Tho  following  four  aspocU 
of  conditional  density  functions  will  be  unod  frequently*. 

(1)  For  random  variables  g  and  b  with  Joint  probability  density  function  p(a.b)  ,  the  conditional 
density  of  |  ,  liven  b  ,  It  defined  as 

p<»lb>  £  ““  ■  a  1) 

p(fc) 

(11)  For  random  variables  g  ,  b  .  and  a  ,  It  follows  from  (2.  1)  that 

p(».blfi)  ~  p(h!c)p(nlb.a)  ■  <2. a> 

This  Is  known  as  the  chain  luls, 

(ill)  Further,  It  can  be  seen  from  (3.3)  und  tho  properties  of  density  functions  that* 

p(iIe)  =  J  p(glb,a)p(b!a)  dt  .  (3.3) 

This  it  an  Integrated  form  of  the  chain  rule  and  ia  essentially  the  Chapman-Kolmogorov  aquation. 


(lv)  Equation  (3.1)  also  Implies  that 


P<}lb>  * 


p(blg)p(i> 


Thia  relation  la  known  as  Bay#*'  a  rule  and  la  the  source  tor  the  term  used  to  describe  the  approach 
In  this  section. 

i.  1  Performance  Criteria  Conalderatlona 

Equation!  (1.30)  and  (1.21)  and  the  concomitant  density  functions  provide  tht  information  required  for  tho 
Bayetlsn  formulation  of  the  problem.  Before  going  to  the  development  of  the  a  posteriori  density  relatlohe, 
first  note  that  the  solution  of  the  unblaeed.  minimum  variance  estimation  problem,  an  posad  in  Chapter  1,  Is 
obtained  If  the  a  posteriori  dnnelty  of  the  etate  conditioned  on  all  available  measurement  data  la  known.  This 
ia  demonstrated  In  the  following  statement. 

7?i«ore»  2.1 

Suppose  that  a  random  variable  g  la  to  be  eat  lusted  from  measurement  data  2  and  auppoae  that  g  and  2 
bava  tht  Joint  probability  density  function  p(g,Z)  .  The  unblaeed  estimate  of  1  based  on  tht  data  2  that 
yields  the  minimum  error  variance 

E[(i-l)T(j-$)3  =  minimum 

ia  givan  by 

t  =1  '  sljlz]  •  <2.  5) 

Proof:  First,  write  the  error  variance  In  terms  of  the  conditional  dsnslty,  using  tho  identity 

=  E{E[(X-i)T(J-g)l2]>  . 

Clearly,  to  mlnimlza  the  error  variance  it  is  sufficient  to  minimize  the  conditional  expectation.  Thus,  ooneider 

E[(g-i>T<g-8>l2j-  =  ft-  2iTs[gl2]  +  e[jtsIs] 

=  (I-E[jls])T(i-E[iisl)  + 

+  E[jTll2)  -  (E[jl2})TE[jl5]  .  (2,8) 

Only  the  first  term  in  (2.8)  involves  {  .  It  la  quadratic,  to  that  the  amalleet  value  it  con  assume  is  zero. 
All  obtains  ehtn 

t  =  Elglzl  . 
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This  complete*  tho  proof  and  demonstrates  that  the  first  moment  of  p(jig)  provides  the  unbiased,  minimum 
variance  eatlaate  of  j  . 

Tho  alnlaum  error  variance  criterion  U  only  one  of  many  criteria  that  could  be  solected.  It  has  been 
frequently  stated  that  it  is  used  because  it  is  more  tractable  analytically  and  not  always  because  It  is  the 
lost  appropriate  for  tho  problem.  Thin  Implies  that  the  minimum  variance  estimates  represent  t  very  specialized 
class.  However,  Biioman’  demonstrated  that  the  reacts  obtained  for  this  criterion  actually  apply  to  a  broader 
nlaaa  of  coat  functions  that  includes  many  other  meaningful  criteria. 


Consider  a  general  error  criterion  L(5)  whore  iQ(x-i)  and  the  L  has  the  following  characteristics: 
(1)  L  is  symmetric  so  that 

L(«)  =  L(-ji)  ■  (2  1) 


(11)  L  Is  convex  so  that 
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LtXJ,  ♦  (1-  MIj]  <XL(ii)  +  (l-\)L(ij)  .  X  >  0  ■  (2.8) 

This  class  certainl.v  includes  the  minimum  variance  criterion 

L.V  ■  vi 

and  the  abaolute  error  criterion 

^abi'  =  HI  • 

Suppose  that  the  5  is  tq  be  estimated  from  data  ?  .  Then  the  following  result  Is  applicable. 

Theorem  2.2: 

It  the  conditional  density  p(nljj)  Is  symmetric  about  Its  mean  value,  then  the  estimate  J  that  minimizes 
any  coat  function  L  In  this  clans  Is  identical  with  the  estimate  gay  obtained  with  the  minimum  variance 
criterion. 

Proof:  It  is  desired  that  the  estlmato  £  that  minimizes  the  expected  value  of  L(j)  be  determined.  First, 
not*  that 

E&<£)lzl  s  EfL(s-£)lzl  =  Sk(£-j)lz]  , 

•here  the  symmetry  of  L  has  been  used. 

Let  t  £  j  .. 

”  J  -  E[jl5l  • 

Then,  observing  that 

S[Mi-|)|g]  =  |_”  Lfs-S)p(slZ)  dj  , 
and  using  the  definition  of  t  ,  this  becomes 

Ek(s-J)lz]  =  £  b(« +£„- J)p(elg)  d<  . 

But  it  has  been  assumed  that  p(jlz)  1*  symmetric  about  the  mean,  ao  tbla  implies  that 

P(£lZ)  =  P(-«IZ)  ■ 

Thus  on*  obtain* 

stM*-i)la!  =  £  M-£+i,t-i>P(4lSV  de 

-  £  L<S-Jav  *«>P(llZ>  de 
=  £  fc<i-ily~«>P(£lZ)  de  . 

Ualng  these  Identities,  It  follows  that 

E[L(i-J)ISl  =  t  E{L(«  +  (i-J„»IZ>  t  i  E{L(c-(t-S„))IZ}  . 
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But  L  li  convex  so 

■  iMa-gilzl  >  e{l[|(£  =  s{L(*>lz)  ■ 

Froa  the  definition  of  <  ,  it  sen  be  eosn  that  equality  occur*  if  |  =  {|y  . 

Obierve  that,  if  L  1*  required  to  be  etrictly  ooiivur..  the  £  in  unique  and  must  equal  £iv  . 

Thla  result  can  bt  extended  to  non-convux  coat  functions  by  considering  the  following  statement. 

Theortm  2 .3 

Suppose  that  L  le  symmetric  and  uou-decreaelng  and  that  p(|lzi  is  symmetric  about  tho  moan.  Suppose  also 
that  p(glz)  la  unlmodal  end  satf.afler,  the  condition* 

lie  Us)p(jlz)  =  0  . 

S-“ 

Then  the  |  that  alninlzea  a  cost  function  L  in  this  olaaa  is  identical  to  the  minimum  variance  aetimata  £>v 
Hie  proof  la  similar  to  that  of  Thtortm  2. 2  and  la  omitted, 

This  theorem  permit*  a  variat'y  of  non-ootivtx  ooat  function*  to  be  considered.  For  example  it  la  aometleea 
sore  meaningful  to  vaign  equally  all  errora  larger  than  a  osrtein  magnitude,  alnoe  any  errors  larger  than  the 
preeorlbed  limit  may  ba  undesirable,  Thus,  one  could  consider  g  modified  minimum  variance  criterion  in  which 
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Another  example  would  be  the  uniform  coat  function  in  whioh  errors  within  t  certain  magnitude  ere  accepted  without 
cost  and  all  other  errors  are  weighted  equally.  Thla  is  described  by  the  following  function 
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This  ooat  criterion  is  oloaely  connected  to  the  naxinum  a  posteriori  density.  Consider  the  expeoted  cost  for 
this  criterion, 

bLL(X)]  =  E{E[L(g)jz]} 


=  J."  |  [I  “<a>p(ilz)  djj  p(S>  dz 

•r.i-tr, 


P(SlZ>  dj 


p(Z>  dZ  . 


where  |UBf  is  the  estimate  aeuooiated  with  this  criterion.  The  cost  is  minimised  by  maximizing  the  inner 
integral.  For  small  enough  values  of  k  ,  the  best  choice  is  eissntlally  the  aosisua  value  of  the  a  potttriori 
danslty.  Estimates  of  this  type  are  discussed  in  Section  3.  Hie  theorem  izplite  thst  the  maximum  a  posteriori 
estimates  are  equivalent  to  the  minimum  variance  estimates  when  the  appropriate  conditions  are  satisfied. 

2.2  The  a  potttriori  Density  Function 

The  a  potttriori  density  function  can  be  aaen  froa  the  practdlng  dlacuaalon  to  provide  all  of  the  information 
required  to  determine  estimates  for  any  coat  functions.  One  of  the  principal  advantages  of  the  Kalman  filter 
equations  la  their  resursivt  character,  which  enables  new  measurements  to  be  prooeased  without  reprocessing 
older  data.  Thus,  consider  the  problem  of  determining  the  filtering  density  in  a  recursive  fashion.  The  following 
theoraa  provides  the  desired  rolatlons. 
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Thtortm  2. 4 

For  the  tyetes  (1.20)  -  (1.21),  the  a  posteriori  density  funotion  P(&kIZg)  evolvji  according  to 


i,  .  _  «*k|8k-i»,(*kl>k> 

-  Hl.lt>.,>- 


(3.2) 


7? ..y  S"V  - 


■hire  the  normalizing  constant  1« 


P(ZkiZii- 1>  =  JP<£k!Zk- t>P<Sk)Zk>  dSk  ' 

The  prediction  density  IKsJZk-i'  la  deuorlbod  by 

P(»klZk-l>  =  JP<Sklak.  i)P<Su- 1  IZk- 1>  d»k- 1  (2M) 

The  initial  condition  p(j0|jD)  ia  given  by 


P<Z0l>a> 


P<Z<ll»o)P<*o) 

P(i0) 


Proof:  First,  note  that  the  initial  condition  follows  Immediately  from  B&yes'n  rule  (2.4). 
Couslder  arbitrary  k  .  From  the  chain  rule  (2.2).  one  aoea  that 

P<Sk-3kIZk. t)  -  PlEklZkWSk'Zk-^  ; 


■o  that 

P(SklZk> 

.  p(jk.SklZk.i> 

P<lk>2k-1> 

The  chain  rule  aleo  enables  one 

to  write 

PtftkZklZk-i’ 

-  Pizklzk. Zk.  yipf&m^s- 

whioh  can  bs  simplified  to 

p<*k'  akIZk-i> 

-  P(Zkllk>f'Ekl3k.i)  • 

tinea  |k  ,  given  ,  ia  indopendont  of  2k. i  •  Equating  the  two  relatione  for  D Cj(k. Zkl 3k- 1 >  ,  one  obtains 


wdi..  ■  . 

P(*kl  ag- 1> 


fbioh  proves  (2.0). 

The  normalizing  constant  is  determined  immediately  by  using  the  condition  that 

Jp<2kISk>  d4k  =  1. 

The  proof  of  (2.10)  follows  from  the  integrated  chain  rule  (2.3).  Note  that 

P(*kIZk-i>  3  Jpc*kllk- i-Zk- ,)PCak- L>Zk- 1>  d<k-i  ■ 


•blob  reducae  to 


p«kizk.i)  *  Jp(iklW><ik-.l3k-i>  d*k-i  • 

thereby  proving  (2. 10)  sod  completing  the  proof  of  the  lemma. 

Several  oharaoterlatlca  of  (2.11)  and  (2.10)  require  diioueslon,  First,  not*  tbat  tbs  dsnslty  P CEk I ik)  ln 
(2,9)  la  defined  by  the  aeaaureaont  model  (1.21)  and  the  presorlbsd  density  function  for  the  measurement  noise. 
Similarly,  the  density  p(jklskl)  appsaring  in  (2.10)  is  defined  by  the  plant  Equation  (1.20)  and  tbe  density 
function  prescribed  for  the  plant  uoiaa.  Thus,  theoretically,  ona  knows  these  two  functions,  The  initlsl 
a  posteriori  density  p(j„lg0)  is  known  from  u  priori  Information  so  it  ia  possible  to  determine  the  a  posteriori 
density  P(xkIZk)  for  any  subsequent  value  of  k  , 

In  a  practical  lense  several  difficulties  hinder  grsatly  or  prsvsnt  p(akl{k)  from  being  determined. 

(I.)  fhe  plant  and  measurement  equations,  £k  and  &k  •  **?  inhibit  ths  datsrminatlon  of  the  P<Sk I *"d 
PiZkllt. i>  '  To  *vcud  this  dlffloulty,  it  is  frequently  assumed  that  the  plant  and  aeasurement  noise 
are  additive.  Then  the  plant  uid  measurenent  equations  take  the  fora 


Ik  3  tk<*k- +  Ik-i 

(2.  11) 

and 

Ik*  3  ik<*k>  +  Ik  • 

(2.12) 

It  1»  ftlso  conmon  to  isBUrao  that  theae  nolso  sequence*!  sre  gsusslsn,  with  donsltles 

P<£|t)  =  k.  <sxp{-  i  ll&'si,)  (2.  13) 

P<Yk)  '  ky  oxp {-  iyjRi'Yii)  ■  .  (3.  M) 

Uilng  (2.11)  -  (2.14),  It  fo llowfl  that 

pdkHk-i1  -  k»  •*»{-  •  tak -£ktak. Cah - rk<jk. t) ] J  (2.i») 

P(*klSk>  =  kv  sxpj-  I  (ak-tl(ik)]JrIfk1[z|l-|lk(fck)]j.  (3.18) 

Thli  ehow*  that  the  difficulty  In  determining  thone  conditional  deneltlae  la  avoided  by  assuming 
additive  noiae. 

(11)  The  Integration  required  In  (2.  10)  cannot  generally  be  accomplished  in  a  cloned  form.  Tho  principal 
exception  occura  when  the  plant  and  iiuaauremunt  equations  aro  linear  and  tho  initial  state  and  the  noise 
sequences  ire  gauSHlnn. 

(Ill)  Equation  (2.2)  raquirea  the  multiplication  uf  two  function*  ao,  if  they  are  known,  the  p(jkljk)  can 
at  leaat  be  determined  to  within  a  multiplicative  oonatant,  It  la  lmpoaaibla  in  moat  initanoea  to 
oomputa  mooenti  or  expooted  valuta  of  particular  quantitiee  (e.g.  ooat  function*)  In  a  cloaad  form,  *o 
that  th*  **tiiutlon  problem  can  not  actually  be  aolvad  through  knowledge  of  the  c  poitiriori  density 
function.  Again  the  major  exception  occur*  when  the  system  is  linear  and  gauaelan.  This  caae  la  traatad 
later  iu  thia  faction  where  It  1*  aecn  that  the  Kalman  filter  equations  describe  the  mean  and  covariance 
of  tho  gauaalan  a  posteriori  density  function, 

To  drouavint  tha  difficultly*  doaorlbad  in  ltemi  (11)  and  (ill),  metboda  for  approximating  th*  danalty  function 
have  beqn  proposed1' 10.  Theae  aapeeta  are  beyond  the  aoope  of  thia  chapter. 

Th*  raouralve  a  postiriori  density  funation  relatione  for  tlme-dlaorete  ayatama  have  their  analog  for  tims- 
eontiououa  ayatena.  Stratonovioh11  fibat  derived  a  partial  diffarontial  equation  to  describe  the  evolution  of 
P(S(t)l2(t>)  .  Subsequently,  Kushaer.11  and,  then  Buoy13  modified  thaee  result*  oonnlm-.ent  with  tha  Ito  stoohaatlo 
caloulu*.  These  equations  for  tha  a  posteriori  dsnslty  srs  very  difficult  to  solve.  Linear,  gauaalan  ayatems 
art  again  the  principal  oaaa  for  whloh  aolutlonn  oan  b*  obtained.  Fisher.1*  bee  attempted  to  obtain  approxlmata 
■solution*. 

a.  3  Linear,  Oauaalan  System 

Suppose  that  tha  plant  and  moaauremant  data  are  described  by  linear  equations  so  that  tha  eyatai  la 

Ik  =  *k,k-lik-l  +  *k-l  «■«) 

Ik  *  Mk  +  Ik  •  <a- 

share  the  initiel  state  la  a  gauaalan  random  variable  with  density  funotlon 

P(20>  3  ko  «I>H  (Jo -»>T  <3»> 

and  the  plant  and  maiureacnt  noiae  aequancai  are  goueaian  wt.lte-noleo  with  density  funotlona  defined  by  (2. 11) 
end  (2. 14). 

Pur  this  linear,  gauaalan  system  th*  a  posteriori  danalty  funotlon  la  charaotarlzed  by  th*  following  result. 
Theorem  1.5 

Tha  a  posteriori  density  p(jklzk)  for  the  ayatem  (2.17).  (2.18)  la  gauaalan 

P<*kl2k>  =  ((2v7)»|Pk|]-w‘  •*p<-i(ik-tk)TPi1(Sk-£k>>  •  <3») 


with  man  value  given  by 

Ik  -  H*  »k<lk-Hk*k>  •  <a'al> 

The  Jk  represents  the  men  value  of  the  a  posteriori  density  p(xk|zk.1)  end  le 

Ik  =  Et*kl2k-J  =  ®k,k-l*k-l  '  (2.22) 

The  matrix  Pk  le  the  covariance  of  P(z^lzk- 1)  *od  )  i 

3  K t <*„  - ii)  C2k -  ft i) ’  1  ah . =  Vnft-i*i,n  ♦  Vi  •  <aa3>' 
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(til)  It  oan  b#  proven  thnt 


J”  *ip[btI-«'(A*]  d*  =  tra/'a |a|  *  1 '*  **p  [i  (JT  A*  la] 

for  any  oonplix  a  and  posltlva-dafUitU  A  . 

' ' ^riariha  definition*  it  follow*  that  tha  oharaotariatio  funotlon  for  j0  la 

<*>(*,)  >  awtilj  »-i  «5W  • 

for  p(|kljk)  and  p(»ktlllk)  the  oharaotariatio  funotlona  are 

$(lr)  *  axp{ia^Hkik  -  t*jRkl,> 

<#!,>  =  *xp{i»l'tk,ilkik-illaki.)  ■ 

To  aoooopllah  tha  proof,  firat  obaerv*  that  th*  oharaotariatio  funotlon  of  p(ikl*k)  la 

&ak)  =  J  «P<l#Jak)P(ikIZ|,)  dIk 


— i — | -  j  *ip[-i(|k/k.1'-ik)T  lk  -  iuj*k]  ,Wlk/k.i>'#'(lT)  d(ik,4v,»k/k.,)  •  <2- ' 

*P(AklZk-  i> 


Kk  la  a  lain  matrix  defined  by 

Kk  =  PjHj<llkpk,,k  *Kk'‘‘  ■ 

Tlie  oovariano*  matrix  of  p(jskljk)  lu  doflnad  an  Pk  and  la  given  by 

Pk  =  E[(Sk-ik)(Sk-*k)TIZk5  =  •‘k-Wk- 

Aflauoiing  th*  firat  moanuremont  occur*  at  t0  ,  tho  initial  donnity  in  P(£0)  ;  *o 

Jq  “  ft  +  K0(20  -  H0l)  • 

•here  K0  s  M0Hj(H0M3Hj  *  R0) 


i Sota  tuo  equat  limit  describing  the  conditional  neon  and  covariance  art  identical  with  tho  Kalman  filter  equations. 
Thi*  i>  not  unexpected.  sino«  it  ban  boon  shown  that  the  conditional  moan  provides  tho  minimum  variance  eetimate. 
Thu*  in  the  linear  aaso  the  Bayeaian  approach  yieldn  tho  results  presented  in  Chapter  1.  It  should  also  be  noted 
that  thi  covariance  of  the  conditional  density  is  independent  of  the  Measurement  data.  Aa  a  roeult  tho  conditional 
covariance  is  identical  with  the  covariance  of  the  error  in  tho  estimate.  That  la, 

pk  =  E[(sk-ikHsk-ik)Tlzk)  *  *t<jk-lkxik-*k>T)  • 

It  1*  lataraatlni  that  tha  proof1  of  tha  thanraa  la  moat  aaally  aocompllahnd  by  raaortin*  to  th*  uao  of 
oharaotariatio  funotlon*.  Thlt  approach  la  takan  hara,  Certainly,  diraot  avaluution  of  tho  gcnornl  roouralon 
ralatlona  (2,0)  and  (2.  10)  will  provld*  aa  aqulvalant  raault,  but  it  la  lnteraating  to  not*  that  It  la  tha  raault 
■tatad  In  aeotian  2.  1.4  of  Chaptar  1  a*  an  altarnatlva  fom,  Thia  oooura  baoauaa  th*  dahalty  funotlona  lnvolv* 
tha  invaraa  of  tha  covariance  matrix;  au  ono  obtains  .  Pk'  rathar  thnn  Pk  whan  prooradlng  diraotly  Trom  (2.9) 
and  (2. 10).  On  th*  othar  hand  oharaotariutlo  funotlona  requite  tho  covarliuio*  matricoa  and  not  tholr  inveraoa, 
ao  thia  appear*  to  hava  aavarnl  advantages.  Hainan  pointad  out  that  it  is  moru  aat.lafying  to  daal  with  tha 
oharaotariatio  funotlon  formulation  alno*  than  H,  ,  Ck  ,  Hk  n»ud  not  b*  aaaumod  to  b*  poaltivo-dafinlta. 

Bafor*  prooaodlng  with  tha  proof  acme  oharaotariatio  funotlon  ralatlona  ahall  b*  atatad. 

(1)  Th*  oharaotariatio  funotlon  *  and  th#  probability  (Utility  funotlon  p  maaooiated  with’*  random 
variable  j  form  a  Courier  tranaform  pair 

*<*)  £  I taxpdi1!)!  »  J  Mp(laTS)P(S)  di  (J‘  M> 

p(i)  £  <W"  j  •*P(-lltjV#(0)  dg  . 

(il)  It  la  alto  uaaful  to  recognize  that 

(2W)""  j  axp[llTl]  dj  a  5(|l  ,  (3.30) 

whara  5(.)  i*  tha  Dlrao  delta  funotlon. 
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Not*  tl»o  that  tho  characteristic  function  of  i* 

=  J  lak^fSk'Zk-*5  dik 

*  «pt-i(B,-lk/k -1>T  2k  -  Hk-ilSk-i1  * 

»  ^(»,yW»k.|)*l<ik.|.*k'K'#k-i'  ■  (2.30) 

Uiln*  th«  above  relation!,  tho  proof  follows  In  n  straightforward  manner. 

Proof:  Th«  Initial  condition*  (2.20)  and  (2.27)  will  he  established,  Use  (2.32)  and  (2.33)  In  (J.  38).  Then 

^fio)  =  — ^ .““j  i  *XP[-1(S,  -  Bo  -  «J*V>T  *o  " 

-  tsjs0  *  IbS*  -  ieI«oSB  *  *9vRofiv)  d(5B,av,x0)  . 

Integrate  with  respect  to  i0  and  use  (3.30).  Then  one  obtains 

*<*»>  =  ('5^^')  1  S("Ifiv+»o-B«>  + 

-  -'tBXlv]d(|r|,)  ., 

Moause  of  tho  delta  function  Integration  with  respect  to  is  trivial,  »o  title  reduces  to 
*.g>  3  •XffiflS*- *lj“oflo3  •*P<l5C-i  <*0  -  H0*)  -H,Molo]  - 

“  +bJ(H0M0hJ  +R0)ky)  d*y  . 


Using  (3.31)  and  evaluating  p(*,)  ,  it  fallow*  that 

^(B0)  ■  •*P<iBo[l  '■*,<*„ -  ll?CM1-ICoH1M,]|,>  .  (3.37) 

But  thla  la  the  characteristic  funotlon  of  a  gsusaian  variable  with  mean  and  covariance  described  by  (2.3(1) 
and  (3.37). 

To  verify  (3.33)  and  (2.33),  asause  that  the  lemma  Is  true  for  tk>1  and  form  0<fik/k-i)  >  uelng  (2.3d). 

Thla  follows  in  a  stralehtforward  Banner  as  does  the  proof  of  (3.21),  (2.24),  and  (3.25),  using  (2.35).  The 
details  *r*  omitted. 

The  use  of  characteristic  functions  has  eliminated  the  requirement  that  the  a  priori  distribution!  have 
nonalngular  covariance  matrices.  In  addition,  the  development  leads  direotly  to  tbs  equation*  presented  in  the 
theorem  whlah  have  come  to  b*  known  as  the  Kalman  filter  equations.  As  an  alternative,  it  is  possible  to  derlvo 
the  density  relations  directly  from  (2.9)  and  (3.10),  The  direct  application  of  these  equations  leads  to  an 
equivalent  set  of  equations  under  the  assumption  that  all  of  tbe  a  priori  covarlsnoe  matrices  are  nonsingular 
but  which  have  some  important  differences.  The  density  is,  of  course,  still  described  by  (2.20)  and  ths  mean 
value*  given  by  (2.21)  and  (2.22)  are  unchanged,  as  Is  the  covariance  P£  described  by  (2.33).  However,  the 
covarlsnoe  and  gain  take  the  following  fora 

p;‘  «  (Pg)'1  +  (2.38) 

*k  *  PkHkRk‘  •  (3.39)' 

of  importer o*  her*  is  the  observation  that  the  nun  matrix  Pk  must  be  inverted,  rather  than  the  asm  matrix 
(HkP|Hk  +Rg)  appearing  in  (3.24).  Sinoe  a  may  be  significantly  smaller  than  n  ,  this  is  an  important 
computational  consideration.  It  is  shown  in  Beotion  2.4  of  Chapter  1  that  the  two  representations  are  related 
through  the  uae  of  a  matrix  inversion  Ismma. 
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3,  MAXIMUM  A  POSTIMOM  AND  MAXIMUM  LIKELIHOOD 
ESTIMATES 

In  the  procedlng  aeotlon,  recursive  rotations  tor  tho  u  posteriori  density  funotlon  wort  developed  which  ltd 
In  s  natural  way  to  tha  recursive  Kulmaa  flltor  equations  wlisn  tho  system  w*j  assumed  to  bo  linear  and  saints  Inn. 

In  this  section  thn  density  functions  will  not  be  written  In  s  recursive  fashion  sml  tho  considerations  wll 1  loud 
to  the  maximum  a  posteriori  estimation  procedure.  Wien  tho  system  is  assumed  tu  be  1  incur ,  thu  Kslmun  equations 
are  obtained  eiielu,  as  must  bo  the  cues  because  of  tho  Theorem  3.4.  This  discussion  oen  still  bo  considered  to 
be  Bayesian  slnoo  the  results  ere  obtained  using  Hayes's  rule  to  describe  the  o  posteriori  density.  Again,  the 
density  relations  will  be  non-recurslve  and  this  aspect  constitutes  tbs  primary  difference  from  the  diaiuaalon  of 
Section  3. 

3.1  The  Maximum  n  posteriori  Estimation  Problem 

Consider  tho  collection  of  all  states  Xk  (l.e,  J0. l,, . . . ,  Sk)  and  all  measurement  data  2s  Arc  described 

In  general  by  (1.20)  and  (1.31)  and  suppose  that  8k  »nd  Zk  have  the  Joint  density  p(8k.Zk)  .  Then,  by  Bayes’s 
rule  (3.4),  It  foUown  that 


*  "  p(3k) 

.  P(Zkllik)li(Xk) 
P<Zk> 

But  the  aeasureoont  noise  Is  Independent  between  samples,  so  that 


P<ZkIJSk)  8  Pv*o l*o>P<*l 1  ill  P<2k|Sk>  r  P (Bi ISi) 


and  (3,  3)  beconon 


P<XkIZk> 


P<2S|g>  ]Vp(Sili!> 


Also,  the  definition  of  the  plant  and  plant  noise  allows  one  to  write 
P(Xk)  =  PdklZk.i)P<2(k..i> 

=  p(ikisk.i)p(sk.iijk.i)  •••  PdiitoiPdo) 


so  that  (3. 4)  can  be  rewritten  as 


P(2kISk) 


P(»0)  fa  »<»il*i-t)  • 

p(j,i  [|^  Pdil*!.,)  jV  p(*jiij)j 


As  pointed  out  In  Beotian  3,  the  densities  Pdidi.L)  and  p(j^|jj)  are  defined  by  the  plant  and  measurament 
nolle  oharaotsrlstloi  and  the  equations  dssorlblng  the  two  syeteeu),  If  the  nolle  sequences  inter  nonllnearly, 
it  osn  be  very  diffloult  to  define  these  conditional  dsnsitlee  In  a  trsctable  fora.  To  olrouiavent  this  probUoi. 
suppose  that  the  noise  enters  sddltivsly  sod  is  gsussitn,  ts  described  by  (3. 11)  -  (3.14).  Then  Equation  (3.  18) 
end  Equation  (3.  IS)  apply  and  (3. 8)  osn  be  written  store  explicitly,  In  particular,  It  is  sum  that 


»<Zklxk>  -  C,  aspj-  \  jfc  [li-ludil]7  *'il[»i-llidi)JJ 
.  ^  <\  espj-  {  fa  |]  *1  -  3idi>  |||.i|  . 
p(2k)  =  Pdo>  c,  »xp|-  i  fa  ||  ji  -  ikdi.,)  ll‘.ii  |  ■ 


'  *  4  '  »  a  «  „  %  ^  I  .  I 

’  .  •  •  •  ►  • 


E.M.nei»ie.l»i>e*.-My.i  ■mwVAMi-.. 

-,m-'  . 

.•-VfV-:.  ■ 


■  I,- » -  j 


«“  *■  s  ■*  i  4  L 

f  •-  K  •  *  ’  » 


.V*N  ,V V 


-  •••  .‘A*-  .*- 


•.vV^VA-'V- V* J 

V«  >  '4 


<1  '  -s'  m  *  a.  •#  ...  ■  j  •»  ,  »  ‘  'J 


Auayninii  that  la  gauaalan, 

(3.8) 

beoomoa 

A  i 

W  P(2k  2,5  a  o  exp 

■*[' 

J,  ^ 

,11  *1  -  >‘l(*i>llj-1l 

.  (3.9)  * 

where  0  In  a  noraulliing  conntint, 


The  a  poittriori  deneity  P(X|,lZk)  contains  the  information  roqulrml  to  obtain  entlmetos  of  eny  or  elf  of 
the  etatuc  .  An  dlacuaeed  earlier,  entimutaa  for  many  criteria  cannot  actually  bo  obtained  bncauae  of  the 
complications  Introduced  by  the  nonllnoarlt.lee.  Ihiwovor,  a  reasonable  estimate  to  try  to  obtain  la 'the  maximum 
a  poetrriori  estimate  daicrlbed  In  Bootlon  3.  In  thin  onsu  or.e  attempts  to  determlnu  the  mode  (l.a.  the  minimum) 
of  P <2S({ I Zk)  1  Till*  in  equivalent  to  onncaing  the  estimates  of  ^  aa  those  values  which  mlnlmlxe  the  ncaatlvn 
of  the  exnonent  of  the  a  poittriori  denalty.  Lot  • 


Lk  =  i  II  lo  ”  •  II  I  +  i  jfc  II  J,  -  (Si.  i)  II  !  f  1  A !  II  It  -  hi(tj)  II  ,  I  O-  m  . 

«0  l" l  Ui_ i  1*0  "l 

.so 

hk  *  log,  C  -  let,  P(JSkl  Zk)  •  ' 

Tbt  Lk  is  to  be  minimised  through  the  eeleetlon  of  the  eatlmtes.  Equation  (3. 10)  oan  be  put  Into  a  form 
that  le  similar  to  that  for  optimal  control  problem!  ao  that  the  theory  developed  to  solve  those  problems  can 
be  sppllsd. 

As  stated,  the  estimation  problem  has  been  reduced  to  a  daterilniitie  mlnlmlaatlon  problem.  Define  variables 
Ut_  L  so  that  the  plant  oan  be  considered  ta 

ili  e  fk<*k-i>  f  Uk-i 

This  equation  is  elmllar  to  (3.  11)  but  the  ]uL  have  bsen  introduced  to  emphasise  that,  unllko  the  j,,.,  , 
they  era  not  rsndoa  veriablee,  Sow  consider  the  estimation  problem  ea  tha  followiui. 

Cuooae  tha  eaquanooa  end  Uk-1  ao  that  tha  coat  function 

LH  ■  *  H  in  ”  •  It;.,  !■  *  (£,  II  at  -  hl<*t>  11“.!  +  i  5S  II  UA  II (3.  13) 
la  ailnislsed  aubjact  to  the  oonutraint 

2k  *  lk«k.i>  +  Uk-l'  k  *  »>  3, .... N  -  1  .  (3. 13) 

One  can  attrdpt,  to  solve  this*problam  using  the  aathsmatloal  formallaa  of  optimal  control  theory,  It  le 
not  isnerally  possible  for  arhltrury  functions  Jk  and  |)k  but  oan  be  sohieved  when  the  ayatem  In  linear.  The 
gtneral  problem  le  beyond  tha  scope  of  this  chapter  but  the  linear  problem  will  be  oonaiderad  below. 

Jt  should  be  observed  that  the  problem  that  hea  bean  posed  is  ldentieel  to  the  detersinlatla  iweet-equsree 
problem  formulated  In  Seotlon  1.  This  Indicates  that  this  deterministic  problem  bee  been  imbedded  In  a  prob¬ 
abilistic  framework  In  whioh  the  »rrors  and  uncertainties  have  boen  assumed  to  be  gaueslsn  random  variables 
and  white-noise  eaquenoei.  Thue.  the  deterministic  and  probabilistic  problems  ere  not  fundamentally  different 
although  the  laniusie  and  analysis  pruoad'ires  art  very  dissimilar.  This  formulation  has  been  suggested  by  Cox1 1 
for  tiae-dleorete  systems.  Coxu  also  considered  time-continuous  lyetame  in  whioh  the  lumnmtioiw  of  (3.13)  are 
raplsowd  by  integrations  and  the  dlffertnce  Equation  (3. 13)  is  riplaued  by  a  differential  equation.  Datohmendy 
end  Brldhar”  aleo  oonaiderad  the  nonlinear  estimation  problem  in  this  manner  and  derived  a  system  of  equations 
that  are  alnliar  to  those  of  Cox,  Mora  recently,  Morteneen1*  has  considered  tha  tima-oontlnuoua  problam  and 
aura  and  Henrlhaon1'  hava  oonaiderad  tha  ganvraliatd  lawat-aquaraa  procedure  of  Chapter  l  and  have  obtelnd  end 
extended  the  results  of  Datohmendy  and  Jridhar. 

3.1  Maximum  LikaHood  Patimat  Ion  Thaory 

Tha  maximum  likelihood  procedure  that  hee  been  widely  need  ie  closely  relatod  to  the  maximum  a  potttriori 
eetlaatee  of  the  preceding  seotlon,  To  discus*  the  difference,  uonsider  Equation  (3.3).  The  denominator  P(Zk) 
ia  a  normalising  constant  and  can  be  ignored.  In  tha  maximum  a  poittriori  procedure,  tha  estimate  ie  determined 
that  maxlmizaa  P(2klzk)  .  Suppoav  that  tha  a  priori  information  relating  to  the  ,  as  daioribad  by  P(2k)  ■ 
does  not  nuggwnt  that  any  atata  is  more  likely  than  any  otbar.  Than,  the  P(JSk)  will  be  a  uniform  (lenalty  and 
tba  aaximizatlon  of  p(Jfkl2k)  will  actually  ba  detwrmlnsd  by  tha  maximization  of  p(2klnw)  ■  The  vnluee  of 
whioh  are  found  to  anxlaixe  Pl'2kl3k)  era  referred  to  an  anufmua  Uk'-'ihood  ealimctaa  ana  p(2klzk)  in  referred 
to  u  the  likelihood  /unction. 

Maximum  likelihood  aatliutaa  hava  aaverai  propartlae  which  are  desirable  and  have  therefore  aeen  widespread 
application,  for  the  diiouetlon  Immediately  below,  some  of  these  eepects  ere  considered  and  will  we  rslaief  to 
scat  of  the  properties  of  the  Kalman  filter.  For  a  more  complete  discussion  the  reudor  is  referred  to  Cramer 30 
or  van  Treei“. 
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Tho  covaruncr*  of  tho  error  in  nity  estimate  con  bo 'bounded  below  through  a  relatively  ntralghtforwurd  applloa- 
tion  of  tin  Bchwar*  inequality.  Thin  bound  Is  usually  referred  to  an  tho  Cramor-hno  inequality,  In  tbo  fullowlnn 
the  Crnmer-Rac  Inequality  is  proved  for  unbiased  (nuo  van  Trees"  fur  a  treatment  for  hiaaod  ostlmntoe)  estimntoa 
of  an  unknown  veator  parameter  and  then  for  a  random  parameter,  Suppoee  thut  it  is  desired  to  entimatu  an  unknown 
parameter  j  from  measurement  data  .  The  parameter  and .the  data  are  Resumed  to  bo  rotated  according  to 

tk  *  h|,<Mtk)  ■  b  =  1,3 . N  ,  (3,  W) 

where  the  nolao  hna  a  known  distribution.  As  a  result,  the  conditional  density  p(ZNlj)  om  dutermlnud, 

Thioitu  3.1  (Cr asier-flno  Int  quill  ity) 

If  |  Is  any  unbiased  estimate  of  j  based  on  the  measurement  data  gN  ,  then  the  oondltlnnal  oovnrlancn 
of  tho  error  In  the  estimate  given  j  la  bounded  boiow  by  the  inveree,  anaumliK  it  salats,  of  the  Fithir  inform- 
tion  matr*#  J  , 

BUn-fs>(i-f)Tlsl  >  J‘l  ■  ■ 


-  E  ~  log,  p(ZBl»)j  j“  log,  P(S*I»>  !l 


Equality  holds  in  (3. 15)  if,  and  only  if, 


It  la  also  assumed  that 


—  lo(t  PfZNl&)  =  k(X)(8-*)T  ' 


a  fa  ,  1T 

5  k  p<s“u! 


salat  and  are  absolutely  inteireble. 


Proof:  Plret,  consider  that 

■  lj]  *  J  (l-DKIJl)  dSK  =  0, 

■inoe  |  is  unbiased,  Differentiate  both  aides  with  reapeot  to  j  to  obtain 

0  =  J|;  [<I-»)P(8|<Wl2N 

-  |-  J  P<ZNI»>  dZNj  I  *  J(l-J)  3C<^  V  «s 

But  observe  that 

ap(|^IS)  _  ^  lo|<  p(ZNli)|p(SM|j)  . 

eo  one  obtaiae 

I.  «  J(l-j>  [^l0»*  P<ZnI*>]b(ZnI*>  d2s 

*  jj(X-I) lp(Z„li)l  l/,|  ||~  l»*.  P(ZM'X>]  [p(Zm|»>]  |  “8m  •  ■ 

applying  tbe  Bohwarz  inequality,  it  follows  that 

I  <  O(X-S) (|-*)TP(Ssls)  dZJ  J  , 


eo  one  obtain! 


Tbe  mtrla  inequality  A  i  B  menaa  that  (B-A)  l->  non-neiative-def lalie 


whare  J  la  noflnod  by  (3.  1C).  If  J  exist*,  thou  (3,  15)  i*  proven.  It  remain*  to  demonstrate  the  aouoml 

form  fur  tha  Fisher  information  matrix.  Equality  holds  in  (3.  10)  if  ami  only  if 


log,  P(ZNli)  =  K(sHi-Il)  • 


By  definition,  it  is  truo  that 


J  P(S„liO  tiz„  e  1  . 

Differentiate  with  reipect  to  g  ,  Thon  on*  obtain* 


1*3  P'3 

J~P(ZNU>  dZM  *  --  lug,  p(fc„lg>  n(ZNlg)  dz„  *  0  . 


Differentiating  a  aeoond  time  with  renpeot  to  g  ,  it  is  found  that 


Sl/di  log»  p(ZnIj>  dZN  =  lug*  «><2NtajJTp(aNla>  dzN  + 

+  J[itt  l0‘’  p(Z,l*)]t  4  P<Z"U>  dZN 

0  1  l0,‘  p<sKla^Tp<itNl*>  dZ„  +  Jjjjj  lM*  P(ZnIx>]T  fr  l0«u  P(ZNI«)|b(ZnI*)  dZN  , 


Equation  (f.17)  folio**  immediately  and  th*  proof  i*  complete.  Nota  that  the  conditions  on  th*  partial  d*rivativ*a 
an  required  io  that  the  interahangee  of  differentiation  and  integration  are  valid, 


Ttala  theorem  and  th*  Flaher  information  matrix  ran  be  applied  to  th*  linear  filtering  problem  end  eoa* 
lntereeting  rtlatlonahlpe  ere  obtained,  Consider  the  following  example*, 


inoMfitt  J:  Buppoee  that  the  neaiuremtnt  data  are  linearly  related  to  th*  parameter  g  , 

*k  *  HkS  +  -k  » 

end  aaaum*  that  the  note*  ia  geuaslan  and  e ample*  are  Independent, 

Pdg)  =  l<¥  *xp(i  ylRii‘ik>  . 

Thue,  th*  conditional  density  p(jN|g)  is 

P(ZNI»)  “  k  expj-t  jfc  (li-Hjl)’  -Hia>|  , 
where  k  ia  th*  appropriate  normalization  constant,  it  follow*  that 


io«,  p(ZnI»)  =  log,  k  -  i  (Bi -Hta>v  r;1  <*j -Hta) 

^  log,  P(ZKI»)  «  Rj’Hj 

^|^ip«.p(Zgiii]T  =  -fcmx- 


Using  (3.17),  the  Filter  information  aatrlx  i«  found  to  ba 

J  W  jfcoHTg;‘Hl 

and  th*  covariance  of  th*  error  in  any  unblued  estimate  of  g  ii  bounded  by 


B[(S-S)(J-i)T]  > 


If  ixiot*. 
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Eituplt  S:  A*  a  minor  v«rUtion  on  the  praoedltig  axtmplc.  aupponn  that  the  pariunotar  i  la  tlmo-vnrylhg  but 
aatlafloi  the  conatralnt  that 


*k  r  n,k-i*k-i 


k  *  i,  a, 


The  meaxuronwnti  arc  rtuacrlbad  by 


*  "k*k  *  *k  •  <3'  a5> 

Solving  (3. 34)  (or  tho  Initial  atate  j0  ,  otm  baa 

*k  °  *k,a*8  •  (3.30) 

where  -  ♦k.k- A-i'  k-r  •  •  *i,  *  ■ 

Aaaumlng  that  k t  le  nonalngnlar  (or  all  k  ,  tho  meaauremont  equation  boitome* 

*k  =  Hk*k,c*o  +  ik  •  (3.27) 

Equation  (3.27)  ban  osnentially  been  reduced  to  the  samo  furm  as  (3.20),  so  It  follows  that  tho  Elaher  lnturmut ion 

matrix  la 


3  ■-  ft  *M*i,Hl*l,. 


and  the  arror  covariance  la  bounded  by 


Thin  eianpla  la  lmportaut  booauao  It  ahoma  that  tha  riaher  Information  matrix  la  aaaentially  Identical  with 
the  observability  matrix  that  wan  lntroduoan  in  Section  3, 1  of  Chapter  1.  furthermore,  the  crnraer-hna  Inequality 
(3,29)  provide!  a  lower  bound  that  la  vary  almllar  to  tha  bound  praaantkd  in  Section  3.3  of  Chapter  1. 

Any  aatluta  (or  which  equality  holda  in  (3,  It)  la  eald  to  be  an  tfficitnt  eatlmator.  It  hat  been  aeen  that 

equality  occura  if  and  only  If 

g  ' 

p(ZnID  a  C|-|]k(a)  . 

ft  la  aantly  ahown  that,  1(  thia  condition  can  be  eatlaflad,  it  can  be  acoompliehed  by  a  maximum  likelihood 

eitimate. 

The  mktlmimatian  of  p(2Nl{)  atn  be  replaced  by  the  maximlaatlon  of  log,  p(ZNlg)  ,  Then  a  neoeanary  oondltlou 
that  an  intimate  |B|  maxlmlae  log,  p(JjNlg)  la 

3 

^  log,  p(ZKlj)lj.|ii(  •  0  o  (t-*)k(*)l|.|>|  ,  (3.30) 

Thua,  (or  the  laet  relation  to  equal  sero,  tHhnr 

1  *  1.1  (3.31) 

or  k<2ai)  «  0  , 

Condi t loo  (3.31)  1a  aalaotad  alaoa  it  providaa  an  aetlaiata  that  dapenda  upon  tha  data;  ao,  If  an  efficient 
aatlmata  axlata,  It  la  a  maximum  likelihood  eatliata.  If  an  affloiant  aatlmata  done  not  axlat.  than  there  la  no 
■aaaur*  of  the  aaouraoy  of  tha  aatlmata.  Thia  oonatltutaa  a  major  draebaok  of  tbla  approach  or  maximum  a  posteriori 
•itlmatee.  Thua  thara  may  be  unblaaad  aatlmata*  which  yiald  a  "asallar”  error  covariano*  whan  there  ie  no  efficient 
estimate. 

In  abating* Theorem  3.  1,  It  earn  aaeumsd  th«t  an  unknown  paramater  i  was  to  be  treated.  If  i  la  treated  a* 
a  random  variable,  a  almllar  raault  can  be  .. ,  lvad  which  yield*  lnaight  into  tha  sxlatanc*  of  affloiant  aatlmatora. 
Thia  davalopmant  follow*  van  Traaa", 

Thaoram  3.2 

•uppoa#  |  and  her*  Joint  danaity  p(2.Zp)  and  lat  J  b*  any  unblaaad  aatlmata  of  j  baaed  on  the 
meaauraaant  data  Ja  .  Then,  aaaualni  L' 1  exlata,  tha  covariance  of  tb*  error  in  tb*  aatlmata  la  bounded  balow 
tar 

«Ui-lX»-l)Tl  >  L‘l  ,  (3,33) 
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Equality  holds  If  and  only  If 


li>«,  P<*.2h>  = 


Tha  first  and  aacond  partial  darlvatlvas 


(J,ZH)  and 


sEs'H 


ar a  aaauaad  to  oxiat  and  art  absolutely  intogreblo  with  reapont  to  i  and  ZN  .  Also,  It  la  aunumod  that 

H*  &(i)P(i)  =  0  (3.30) 

11*  fc(*)P(i>  *  o,  (3,37) 

1"“* 

whera  fc<g>  $  J  [J-gJp(Zjg)  dZN  ,  (3,38) 

Pim/i  Ilia  proof  la  slnller  to  that  of  Thaoran  3. 1,  althouih  upiotatior.s  with  raapeot  to  (  nuat.  ba  oonaldorad 
alao.  flrat  fora  p(g)fc(g)  and  differentiate  with  raapeot  to  l  .  Thla  yialda 

iKl)fa(l)  =  -  Jp(|.ZH>  dZNl  ♦  J(l-g)  ^  P(J.ZM>  d2a  ■ 

Integrate  with  respect  to  g  and  invoke  oonditlona  (3.30)  and  (3,37)  to  obtain 


0  »  -  I  +  J(|-j>  ~  lo*.  P(X, ZN)  P0.2N)d(a,ZM) 


3  3  r 

—  —  log,  p(g)  ■. 
3j|?I  * 


■Clog,  p(ilZN)]  ■»  k(I-j)’ . 


Intagrata  with  respect  to  g  and  take  the  aotilog  to  obtain 


e(*IZH>  *  w*p£-|  JTJ  +  hlTI  *  «  • 


But  this  lapliaa  that  the  a  poitariori  denelty  p(g|JN)  auat  ha  goun ion  for  an  afflolant  aatinata  to  exlat. 

It  followa  aully  that  a  naxlaun  u  poatariari  aatinata  will  ba  afflolant  If  an  efficient  aatinata  atlats. 
However,  alnow  p(glgN)  nuat  ba  gauaalan  in  tbia  oaaa,  tha  ntnlnun  rarlanoe  aatinator  yialda  tha  sane  rasolt, 
vo  It  la  alao  afflolant, 


'mk  ..  v 

mm. 


mm 

■  ••  V- 
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Application  of  tha  Bohwara  lnaquality  yialda 

i  <  [«{(l-i)(8-i)T»  i* . 

where  L  la  given  by  (3.33)  and  equality  holds  If  and  only  If  (3. 38)  la  aatlaflad.  Nota  that  tha  averaging 
with  rwapaat  to  both  j  and  ZN  lapliaa  that,  unlike  tha  condition  of  Thaoran  1.1.  k  la  a  constant  Independent 

of  both  i  and  Zh  ' 

Tha  reminder  of  tha  proof  ia  Identical  with  that  of  Thaoran  3. 1 . 

Two  results  ralatlng  to  tha  affaot  and  oonatquanca  of  trwatlng  g  is  a  random  paranatar  ara  worth  noting. 

Pint,  tha  natrU  L  aa  given  by  (3.34)  san  ba  rewritten  as 


1,  a  J  -  | 


whan  J  la  defined  In  Thaoran  3. 1.  Thua,  tha  probabilistic  description  of  g  enters  independently  of  tha  noise 
(.'tatiatloa.  Thla  will  ba  diaouaaad  furthar  below. 

Tha  condition  (3. 38)  for  equality  In  (3, 33)  Involves  tha  oonatant  k  .  Note  that  the  condition  oan  ba  written 
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Conalder  theee  reeulte  through  the  following  example. 


SxoMp Iff  3:  Conaider  tha  ayutam  deeorlbed  In  Example  2  with  tho  additional  requirement  that  |0  la  a  gauaalan 
random  varlabla  with  danslty  lunation 

P(is)  =  k„  exp{-  kl0-»>T  M'4‘(J0-1)>  .  (4.41) 

Thau,  tha  information  matrix  L,  ,  aa  gtvan  by  (3,38),  la 

L  =  1  +  |  E 

=  jfc 

and  tha  arror  covarlmco  la  bounded  below  by 

EUio-ioXSo-ito^  >  [m;1  ♦  jfc  *T.  aMiRt,,,l*i. «]  '  ' 

lut  thle  la  aaaantlally  tha  bound  dlaouaaad  In  Station  3. 3  of  Chaptir  1.  Tha  right-hand  aide  raproaenta  tha 
arror  oovarlanot  given  by  tha  Kalman  flltar  for  thia  problem  and  provldea  another  vorlfioation  that  the  minimum 
variance  aatlmator  la  efficient  for  thia  ayatam.  To  obtain  praoiet  agreement,  note  that  tha  eetlmate  of  tha 
taralnal  atata  jN  la  given  by 

a  ®H,  0$  0  • 

It  foliowa  that  tha  error  covarianoa  aaaociated  with  la 

*t(lg-lN)(lN-lN)T]  *  ^K,0  ' 

.  Uaing  thia  relation,  one  obtain#  tha  raault  given  in  Seatiou  3,3.2  of  Chapter  1. 

Thia  oompletee  the  dlaoutalon  of  error  bounde  ualhg  tha  Cramer-llao  Inequality  and  lta  general lmat Iona, 


3.1  maximum  a  posteriori  Eatieiataa  for  Linear  Syatama 

Buppoea  that  tha  plant  and  meaaurament  equations  are  linear,  ao  that  tha  maximum  a  poittriori  eatimatlon 
problem  beoomee  that  of  ohnoaing  tha  aaquanoee  jjN  to  minimima  the  ooat  function 


hH  -  i  II  i»  -  » IIJ.t  +  i  jfc  II  sj  -  hjSi  IJ.j  +  *  Je{  II  ui 


(3.42) 


eubjeot  to  tha  oonatralnt 

2k  1  ♦  (3'43) 

Tha  miolalaation  ie  aooompllahed  Inductively  In  tha  following  manner.  Conaidar  the  ooat  funotlon  after  tha 
flrat  oaaauremant  haa  been  obtained, 


h  =  t  II  it- ill’-i  +  t  II  So  -  Mo  ll!-i  •  <3.44) 

*0  "o 

Aa  will  be  mean,  thia  aimple  problem  containa  within  It  a  major  portion  of  the  problem,  ainoa  a  raouraive 
golutlon  it  to  be  obtained, 

,  Chooee  tha  i,  that  minialcea  L,  and  call  It  J,  ,  A  noceaaary  and  aufflolant  condition  for  thia  problem 


la  that 

fp)  -  o  »  m;‘  <$,-»)  -  h|r;1  c*0-h0*0)  .  (3.4u> 

\  ®*e/ 

Solve  for  |0  to  obtain 

(m;,4-h>;1h0)10  -  m;‘s  +  h;r-5‘s0  (3.4#) 

or  I,  =>  (m-„‘+hX‘h,)'‘  .  0.47) 

Let  P0  $  (m;‘+hJh;‘u,)'1  <3. 48a) 

3  M0  -  MuHjtHgMjHj  t Rs) " 1  h8M0  ,  (3.48b) 

using  the  matrix  inversion  lamme. 


Using  (3.48b),  (3.4?)  becomes 


<e  11  *  +  b0[*4-K0|]  ,  (3.48) 

where  Kc  $  M0H5(HeM0H5  +R0)*‘  .  <3. 80) 

nut  tht  maximum  a  pot  ttriori  iitlemte  of  jt0  ,  given  |  end  i0  ,  it  deecribod  by  (3.4S).  At  suit  be  true, 
thli  agrees  with  the  estimate  derived  in  sootion  3  uaine  the  Btyetltn  raouraion  relations. 

Suppose  now  that  there  ire  two  measurement!  tnd  the  coit  function  L,  le  liven  by 


li  *  *  II  *o  -  •  Hj-i  ♦  i  II  *i  -  Mi  IIJ-i  + 


where  the  2,  ,  end  u3  are  related  by 

*1  1  ^i,  o*o  +  Ho  • 

The  estimate  J0  that  wit  JeMvod  above  will  bo  different  than  that  obtained  by  minimizing  (3.81),  olnoe  two 
metauremonte  are  involved.  In  ftwt,  the  intimate  of  j0  that  la  derived  by  mlnlnlzlnt  (3.81)  la  a  smoothed 
estimate  rather  than  the  filtered  estimate  liven  by  (3.48).  To  obtain  the  desired  reouraion  relation,  aonalder 
L(  and  expreaa  it  relative  to  |0  . 

kj  s  i  II  Ig  “  I  II  [.  i  +  i  II  8o  “  llf.t  ■  (3.83) 

*0  *0 

Expand  in  a  Taylor  eerlea,  wbioh  la  liven  exactly  by 

l*o  -  ill  l0  -  ill!.i  ♦'ill  »e  -  Me  Hj-t  ♦  sr  (*e"le>  + 

'  .  '  *°  ao-to 

+  T  (»„-!„)  T(r4i)  (Jo-*,).  (3.83) 

V*, 

But  «r-  B  0 

3*L  3 

•ad  -jrr  ■  5r  -  «J*;‘(Bo-H*8n)5 

Olo  *1 

*  a;1  ♦  HjiiJ  1h0  i 

•0  h0  s  i  II  tg  *  B  II*.,  +  i  II  So  -  Mo  II!- 1  +  i  II  lo  “  io  II!- i 

*o  *o  po 

3  c,  ♦  ill  l0  -  1,  II'  I  ,  (3.84) 

*0  1 

where  □„  le  independent  of  and  therefore  will  not  have  an  influence  on  eubeequent  diacuaeion. 

The  Lj  is  now  given  by 

li(  ■  c,  e  i  II  i,  -  i„  II*  4  +  II  i,  -  H,»,  II*  ,  +  i  II  u„  II*  ,  ■  (3.88) 

fo  *1  we' 

To  allaicete  j0  ,  Introduce  the  pleat  constraint.  Assuming  that  tha  invent  of  $l  t  exists  and  la  i  , 

Lj  becomes 

Li  h  0,  ♦  *  ||  \  !  (1,-H0)  -  II*  ,  +  II  Si  -  M,  II*  ,  +  i  ||  „  || t  . 

/  r0  *1  u  A*  1 


Now,  choose  the  u0  to  mlnlmHe  L, 


wo*  -♦*/;*  ».,.(*! “fio>  ‘*,1 


Bolvlni  for  Jt,  ,  oro  obtains 
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and  not*  that 

It  followi  from  (3. 57)  and  (3.58)  that 

ill  ♦o.iUi-flo)  -  3lo  H’-i  ♦  *  II S4  II*  ,  = 


pi  =  »i,^o*;,* «« 

VaMI.arr1  *  I-VJ"- 


(3.53) 


0  "  *T  f’  +  ^  ^  Q-1 

W0,  if0  *0,  1  Qfl 


=  ill  Si  -  *1.0*0  IIJ.-I-  +  ill  St  -  *,.ai#  II!,-,  ,-, 

ri  *0M  M  <*0pl 


=  i  II  Si  -  *1,  4,  ll’(M  . 


With  this  relation,  the  cost  function  assumes  the  form 


i  II  s,  -  *i,o*o  II’, -i  +  i  II  »i  -  M,  II’- 1  • 

ri  *i 

Notv  that,  In  the  absence  of  a  nuw  measurement,  the  boat  predicted  estimate  ia 

*!  =  *1, 4o  • 

which  corresponds  with  the  antioipatsd  result. 


(3. 59) 


(3.60) 


(3.81) 


It  can  be  seen  that  (3.60)  has  essentially  the  sans  form  aa  the  Lg  described  by  (3.44),  since  C0  does  not 
depend  upon  j,  .  Thus  minimization  of  Lt  with  respect  to  gt  will  yield  the  result  that  was  obtained  above, 
except  for  the. notation  change.  In  particular,  it  follows  that 

I,  =  *i.o*o  ♦  K,  Cl, 'glgl  .  '  (3-62) 

where  K,  =  P{B*(H1P|H’  +  R,)'1  . .  (3.83) 

Also,  the  cost  h,  la  seen  to  ba  given  by 

t,  »  C,  +11  J,  -  |l*  t  ,  (3.64) 


where 


P,  =  (P(  1  +  HjKJ'Hi)*  1 

=  Pl.-P'H’iHjp'llJ+R,)-1  H,p; 

■  «■!  -  wi  • 


(3.66) 


where 

tad 


The  generalization  to  an  arbitrary  stage  follows  Inductively  and  ia  accomplished  by  using  the  same  arguments 
sa  above.  Thus  it  follows  that  the  raouralve,  maximum  a  posteriori  estimate  is  described  by  tho  system 

*k  =  *k,k-i*k-i  +  Kk  C*k-Hk*x,k-4l,-i5  ■  (3«7) 

Kg  =  PgHjlH^Hj  +  Rjj) ' 1  (3.6#) 

Pg  —  *k,  k- tPk“  v*k ,  k“  i  "**  ®g- 1  (3.69) 

Pg  =  Pg  -  KgHgP£  ■  (3.  TO) 

Once  again,  the  Kalman  filter  equations  have  been  derived. 

4.  SUNNARY  OP  RESULTS 

The  filtering  problem  for  tlme-diaorate,  nonlinear,  stochastic  systems  1ms  been  considered  within  the  general 
probabilistic  framework  provided  by  the  application  of  Bayes1*  rule.  This  Bayesian  approach  provides  Insight 
Into  the  general  character  of  the  behavior  of  the  a  posteriori  density  function  for  nonlinear  systems.  The 
development  has  bsan  designed  to  provide  in  understanding  of  the  difficultiss  arising  in  nonllnaar  filtering 
thsory  sad  provides  a  structure  within  which  the  nonlinear  problem  can  be  attacked,  further,  the  Bayesian 
approach  laade  naturally  to  the  dlaoussion  of  the  maximum  a  posteriori  and  maximum  likelihood  estimation  procedures. 
Tbs  former  procedure  ia  shown  to  be  identical  with  deterministic  lesst-squsres  ehon  the  plant  and  measurement  noise 
sequences  are  assumed  to  be  additive  and  gauseian.  The  recursive  Bayesian  and  maximum  a  posteriori  approaches 
are  aasn  to  yield  the  sue  filtering  equations  as  the  unblaaed,  minumum  variance  estimates  when  the  plant  and 
measurnent  systems  are  linear  with  gauseian  noise. 

The  principal  result!  of  this  presentation  are  stated  in  the  following  paragrsphs.  The  general  problem  is 
atated  In  Section  1.2. 
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Stclion  2.1:  The  conditional  mean  Etjlzl  U  shown  in  Theorem  2.  1  to  provide  the  unbiased.  minimum  variance 
eetlmete  of  a  random  variable  j  from  meaauroment  data  S  ■  Thus,  knowledge  of  the  a  pnttniort  density  pi  c  &  I  Ji> 
would  enable  this  estimate  to  be  determined,  as  well  as  virtually  any  other  type  of  estimate  that  might  be  desired. 

It  la  shown  in  Theorem  2,2  and  In  Theorem  3.3  that  a  significant  number  of  eetimatlon  criteria  will  lead  to 
the  same  sstimats  aa  the  minimum  varianoe  criterion.  Tills  is  important  because  it  indicates  that  the  choice  of 
the  minimum  variance  oi  Karlen  bouuuae  of  ltu  analytical  truotablUty  has  broader  application  than  might  bo 
otherwiae  appreciated. 

Section  2.2;  Recursion  relations  which  deaorlba  the  manner  in  whloh  the  a  posteriori  density  function  changes 
as  new  data  become  available  are  preneuted  as  Theorem  2.4.  Some  of  the  principal  difficulties  that  are  encountered 
In  applying  these  results  to  nonlinear  systems  are  diucuased. 

Section  2.2;  The  general  results  of  flection  2.3  are  applied  to  linear  syBteme  with  gauaslan  noise.  Thoorcm  2.5 
■hows  that  this  system  has  a  gausslsn  a  posteriori  density  and  that  the  Kalman  filtor  equations  describe  the 
conditional  moon  and  covariance  of  p(jklzk)  ■  It  is  pointed  out  that  It  is  more  convenient,  at  losst  In  this 
case,  to  work  with  the  characteristic  function  rather  than  tho  density  Itself  to  derive  the  doeired  results. 

Section  ?.j:  The  maximum  a  posteriori  estimation  procedure  is  presented  essentially  as  a  nonreourslve  version 
of  the  Bayesian  approach  described  In  section  2.  This  formulation  is  seen  to  be  identical  with  the  deterministic 
least-squares  problem  discussed  in  Section  1. 1  when  the  plant  and  measurement  noise  aequenoea  are  asiumod  explicitly 
to  bs  additive  and  gaueeian, 

Section  2.2;  Some  aspects  of  the  well-known  maximum  likelihood  procedure  are  discussed  in  this  aeetion.  It  is  ueai 
that  thla  approach  differs  from  the  maximum  a  posttriori  through  tho  neglect  of  the  u  priori  distribution  assigned 
to  the  psrsmaters  to  be  estimated.  The  two  are  identical  it  p(J{k)  is  uniform.  Then  the  maximum  a  potttriori 
procedure  which  calls  for  the  determination  of  tha  £g  that  maximizes  P(XkIZk)  I*  Identical  with  thi  maximum 
liktllhood  procedure  in  whloh  p(ZkIXk)  1*  maximized  through  the  choiee  of  £k  . 

The  Cramer-Rao  inequality  Is  presented  In  Theorem  3, 1.  This  inequality  provides  a  lower  bound  for  tha  arror 
covariance  matrix  for  any  unbiased  estimate  of  an  unknown  parameter.  Tills  result  is  generalized  in  Theorem  3.2 
to  the  case  where  the  parameter  is  a  random  variable  with  prescribed  distribution.  The  lower  bound  it  the  richer 
information  matrix.  Tor  a  linear  system  with  gsusslwn  measurement  noise  and  no  plant  noise,  the  Cramer-Rao 
inequality  is  shown  to  provide  a  lower  bound  that  la  identical  with  a  bound  derived  in  Section  3.3.3  of  Chapter  1. 
Also,  the  Fisher  information  matrix  is  shown  to  be  identical  to  the  observability  matrix, introduced  in  Seotlon  3.1 
of  Chapter  1, 

Section  3,3:  The  determination  of  the  etatii  sk  that  maximize  p(gklzk)  la  ehown  to  again  ylald  the  Kalman 
filter  aquations.  Tha  procedure  that  is  used  to  accomplish  the  minimization  makes  use  of  the  desire  to  obtain 
a  recursive  solution  end  proeleea  to  provide  etralghtforward  application  to  nonlinear  systems. 

The  preceding  disouseion  provides  s  brief  description  of  the  oontents  of  Sections  2  snd  3.  Tha  reader  la 
directed  to  the  referanoes  for  more  complete  treatments  of  many  aspect a  that  havs  only  been  touched  superficially. 
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NOTATION 

expectation  operator 
conditional  expectation 
backward  diffuelon  operator 
forward  dlffuilon  operator 
Euclidian  N-apaca 
•qual  by  definition 
approximately  equal 

tranepoae 

derivative 

probability  denaity  funotlon 
conditional  probability  denaity  function 
partial  differential  operator 
differential  operator 

the  ele.ent  In  the  1th  row  and  j611  oolunn  of  the  aatrlx  In  braakete 
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CHAPTER  1  >  NONLINEAR  FILTERING  AND  COMPARISON 
tlTII  KALMAN  FILTERING 

Lawrence  Schwarts; 


1.  INTRODUCTION 

Tho  Hold  of  nonlinear  f llt«r Inn  in  quits  broad,  and  a  general  diwouswion  of  the  vartwiH  approaches  is  not  »n 
appropriate  subject  for  a  elnttle  chapter  In  a  book  dedicated  to  Kalman  Filtering.  The  specific  form  of  nonlinear 
filtering  treated  herein  is  that  which  is  most  oloseiy  related  to  Kalman  filtering,  indeed,  that  which  la  the 
neat  natural  general  last  Ion  thereof:  mlniail-verienflo  filtering.  To  further  limit  the  eeopo,  tho  derivation  la 
limited  to  continuous-time  minimal-variance  filtering. 

Curiously  enough,  the  work  that  lad  to  tha  auopoaaful  darlvation  of  nonlinaar  continuoua-tlme  minimal -variance 
filters  dots  not  stam  from  tha  paper  by  Kalman  and  Bucy1  which  cohtalna  tho  derivation  of  tha  linear  continuous- 
tima  mlnimal-varianoo  filter.  Rather,  the  Impetus  derives  from  stratonovlch®,  in  an  even  atrliar  paper,  who 
noted  that  all  the  information  related  to  tha  optimal  eatloata  of  the  state  of  a  eyatem  la  contained  in  the 
eondltlonal  probability  distribution  function. of  tha  state  givtn  tha  measurements.  Thus,  tha  nora  gtntrel  filter 
la  not  an  outgrowth  of  the  more  teatrioted  one  but  the  result  of  a  parallel  line  of  inveetlgation, 

While ‘only  one  approach  to  nonlinear  filtering  la  dlaouaaad  in  detail,  several  nonlinear  flltara  are 
computationally  compand  with  a  Kalman  filter.  All  of  tha  nonlinear  flltara  machaniaad  reduce  to  the  Kalman 
filter  whan  tha  dynamical  equation  of  the  ayatea  It  linear,  the  meaiurementa  are  linearly  related  to  the  atate, 
and  the  noiae  prooaamas  era  flaunt  on.  An  autlln*  of  tha  atapa  In  tha  derivation  la  asaentlsl  to  sat  tha  stags 
for  the  following  discussion.  The  first  step  in  tha  analysis  of  any  physical  situation  la  the  apeolf loatlon  of 
a  mathematical  model:  the  ohoice  should  ba  mads  carefully,  sines  thm  whole  analysis  depends  upon  the  oharauterletloa 
of  the  aodel.  For  minimal  variance,  which  la  a  probabilistic  orli irlon  of  optimality,  tne  manipulation!  leading 
to  the  filter  aquations  are  mad*  particularly  simple  by  asausing  that  the  random  prooeaaai  are  white  nolaea. 

The  formal  simplicity  la  gained  it  the  expense  of  a  certain  amount  of  complication  In  tha  physical  interpretation 
of  tha  mathemaUoal  reiulte. 

Given  the  probabiliatlo  criterion  and  tha  white-noise  assumption,  a  natural  mathematical  model  Is  the 
stochastic  differential  aquation.  Of  course,  tha  problem  must  ba  such  that  tha  stochastic  differential  aquation 
satisfies  axlatanoe  and  unlquanasa  oondltiona,  whleh  art  different  from  those  pertaining  to  nonetochestio 
differential  aquations,  Tha  essential  lifferenea  etesi  from  tha  fact  that  for  whlta-nolae  models  there  la  no 
bound  on  the  forcing  function  and  global  oondltiona  suit  be  satisfied.  From  tha  itoohaitlc  differential 
equations  for  tha  system  and  the  measurement,  It  la  puiilbla  to  derive  a  atoehastio  partial  differential  aquation 
for  tha  conditional  density  funotion.  Tram  the  stochastic  partial  differential  aquation,  in  turn,  it  la  possible 
tc  derive  a  atochaatlo  differential  equation  for  the  eapactad  value  of  any  acalar  funotion  of  the  -stats  of  the 
■yatea;  a  finite  set  of  such  equation*  form  the  vector  equation  for  the  filter.  , 

The  axaot  equation  for  the  filter  raquiraa  the  inatantanaous  evaluation  of  tha  conditional  expectation  of 
several  funotiona  of  tha  stats  of  tha  system.  To  simplify  tha  problem,  tha  original  nodal  can  ba  repUoad  by  an 
apptuiinatlng  atochaatlo  differential  aquation,  from  which  an  approximate  fiUsr  can  he  darivtd  more  simply,  It 
eases  raaa'onabla  to  rtqulra  that  tha  approximate  modal  equations  algo  gatlgfy  existence  and  unlquanasa  oondltiona. 

Ouarantaalng  exlatrnoa  and  unlquenaa*  for  tha  approximate  system  does  not  quite  do  the  iso*  for, tha  filter, 
but  (lightly  atronger  conditions  on  tha  aquations  auffiea.  At  this  point,  one  step  remains  In  the  validation: 
that  of  relating  tha  atochaatlo  differential  equation  for  the  filter  to  an  ordinary  differential  aquation  for  the 
actual  mechanisation.  It  la  shown  by  Behwarts  and  Stair1  that  nonvelid  filter  aquations  alsllar  to  thosa 
previously  derived  by  Schwarts  and  Baas'  and  by  Flaher1  for  white-nolia  processes  can  ba  mad*  computationally 
Identical  to  valid  filter  equations, 

;ii: 

s.  MATHEMATICAL  model 
g.  1  White  Noise 

Tha  ueual  aatheaatioal  formulation  for  a  dynamical  problaa  in  a  differential  equation,  nowadays  moat  ganarally 
written  In  atatm-veotor  form: 

di 

—  »  f(t,x(t),u(t>)  ,  (1)  . 

dt 
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where  i  *nd  f  are  n-veetora,  u  ie  an  a-vector,  and  t  la  a  ecelar,  Tho  meaning  of  (1)  la  wall  known  for 
Boat  input  functions  u  ,  but  tha  ensuing  analysis  cicala  with  whlts-nolss  liip„t  functions,  nnd  (1)  mutt  bo 
ralntcrpratad,  Tho  prcaont  aaetlun  explains  tho  probloms  assnolatsd  with  whito-naise  Input  a,  and  outlinou  Iho 
development  of  tho  necessary  oslculua  of  atochantlc  prooesaee.  Whit*  noise  In  often  described  at  a  random 
proaoaa  with  a  power  apootral  density  which  la  a  constant  or,  equivalent ■  ly.  an  autocorruHtlon  funotion  which 
la  a  Dlrao  8 -funotion,  It  la  furthur  noted  that  such  a  preesaa  has  no  physical  mooning,  since  It  would  require 
Infinite  signal  power.  The  foregoing  definition  Is  valid  for  stationary  white  uolso,  though  the  autocorrelation- 
funotion  definition  can  bo  extended  to  the  nonatationary  case  by  allowing  a  time-varying  coefficient  for  the 
5 -funotion, 

The  nonreallsablllty  at  whlte-nolae  proceeaoa  la  no  reaeon  to  dUoard  them:  they  occupy  a  place  with  reapnot 
to  th*  family  of  atnohastlo  proosssea  analogous  to  tho  place  of  the  birao  S -function  with  rcapeot  to  functions. 

Just  aa  tho  i -function  can  bo  regarded  as  a  limit  of  a  sequence  of  unit-sroa  pulses  of  dsertnaing  width,  a  whilc- 
noiae  prooeaa  can  he  considered  as  tho  limit  cf  a  aoquonoa  of  procaaeaa  which  aie  step  functions.  Moreover, 
both  trs  useful  only  when  their  Integrals  art  considered;  Indeed,  both  can  be  nrnda  mat  hornet  leal ly  rigorous  only 
in  terns  of  their  integrals.  To  be  somewhat  Imprecise,  tho  8-funotion  muy  be  conaldured  an  the  derivative  of  a 
unit  step;  with  similar  Imprecision  wlilto-rclse  is  tho  durlvatlve  of  Brownian  motion. 

The  practical  reason  for  being  concerned  with  whlto-noiso  prooessoa  la  that,  when  differential  equations  aro 
forcad  by  whita-nolaa,  tha  aolutlona  are  Markov  proesaaes,  1,#.,  tha  futura  is  independent  of  tho  past.  In  other 
worda,  tha  aolutlona  to  differential  equations  forced  by  whlta-noisa  exhibit  tha  stochastic  analogue  of  tha 
property  of  aolutlona  to  differential  equation*  forced  by  ordinary  functions:  given  the  etete  of  the  eolutlon  at 
aoa*  time  and  th*  forcing  funotion  from  that  time  on,  th*  aubsaquent  evolution  of  tha  eolutlon  1*  etochaatloally 
lndapandent  of  the  previous  history. 

Th*  mathematical  problem  associated  with  shite-nulec  le  eomewhst  similar  to  that  aasoolatad  with  th*  S-funotlon: 
the  meaning  of  the  integral,  Tha  5 -function  la  not  really  a  funotion  in  th*  ordinary  aanaa  of  th*  word,  and  no 
theory  of  Integration  can  remit  In  a  value  other  than  saro  for 


r-»to 


if  th*  8-funetion  la  aaauatd  to  b*  an  ordinary  funotion  of  t  .  However,  by  not  aaorlbtna  valuaa  to  8(t)  and 
sonaldaring  only  it*  integral,  it  la  possible  to  oonetruat  a  meaningful  theory.  Similarly,  no  ordinary  theory  of 
integration  can  make  aanaa  of 

Jwft)  dt  , 

share  i  iii  whlte-nolae  prooeee.  Her*  again.  If  no  lnatantanaoua  value  la  given  to  w(t)  ,  a  uatful  theory 
of  etoohaetlo  Integration  to  poaalbla;  that  theory  le  outlined  In  the  following  feotion. 

1 1  Btoehaatio  Integrate 

The  exposition  In  thla  aaotinn  la  merely  an  outline  of  tha  mathametlcal  derivation  of  th*  ntoohaatle  Integral, 
and  It  doe*  not  lnolud*  any  diaousalon  of  atoohaatlo  integral*  of  diaoontlnucu*  random  prooeaatx.  A  oomplats 
dlaouaalon  of  atoohaatlo  lntaaratlon  oan  b*  found  in  Bkorokhod*.  Th*  underlying  lden  le  the  deiorlptlon  of  t 
white-note*  prooeee  a*  tha  derivative  of  t  Brownian  motion:  tha  major  difficulty  lit*  In  th*  faot  that  a 
Brownian  motion  fella  to  be  differentiable  lomewhrr*  in  every  interval  of  noniaro  length,  with  probability  on*, 
Thua,  If  b  la  a  Brownian  motion,  db/dt  baa  no  meaning  and 


Jg(t)(db/dt)  dt 


la  ganarally  not  defined,  even  for .oontlnuoue  function*  g 
defined  atochaetio  deacrlption,  and  tho  gtleltje*  Integral 


But,  If  db  is  an  lnorsment  of  b  ,  it  has  a  wsU- 


f$(t)  ®<t) 


Is  s  possibly  meaningful  alternate  form.  However,  b  is  not  a  funotion  of  bounded  variation  and  evan  tha  StleUJea 
lntagral  le  not  defined,  The  etoohaetlo  Integral  is  s  stochastically  meaningful  auneralitabion  of  th*  Stlultjes 
Integral,  in  vhioh  th*  approximating  aunt  rr*  required  to  oonv* r*.e  In  probability  to  th*  Integral,  rather  than  to 
convert*  In  th*  ordinary  tenet, 

1. 3  atochaetio  Differential  Equation* 

Th*  dlaouaalon  contained  In  th*  a equal  1*  limited  to  the  following  aptolml  omit  of  gquatlon  (1): 

^  *  f(t,Kt»  +  g(t, x(t)}u(t)  ,  (j) 

dt 

where  x  end  t  era  n-vectora,  t  la  a  >„alar,  u  la  an  m-veotor  unit,  whlta-nola*  prooeaa  with  independent 
dementi,  and  g  la  an  n  s  a  matrix,  A  vector  whlte-nolae  prooeee  haa  elamanta  derived  from  Wiener  processes; 


:-xjw  v.-Cs-Cv-^  y 


•  WJencr  proeeas  la  a  unit  Brownian  motion,  1 . e. ,  1U  InureavuU  hnve  aeru  uwan  and  variance  equal  to  the  lnlurval 
of  tint  ov«r  which  the  Increment  li  defined,  while  Equation  (2)  ti  leas  gonoral  than  Equation  (1),  it  ia 
•ufflalant  for  neat  practical  applloatloni,  Let  |l  dannta  the  l">  column  of  g  and  w.  tha  rh  row  of  the 
vaotor  Wiener  proocaa  from  which  u  1*  derived ,  Then,  by  formal  multiplication  of  Eguntlon  (3)  by  dt  and 
lntairatlnn  of  the  raaultini  expression,  Equation  (2)  oan  be  rewritten  aa 


x(t)  -  x'%) 


ft  f(a,x(s))  da  +  g1(a,a(a))  dw.(a) 

\  4rt 


(3) 


In  Equation  (3),  the  firat  integral  la  an  ordinary  integral,  and  the  remaining  m  Integral!  are  atcohaatlo 
lntagrala.  For  almplloity,  If  the  atoohaatlc  Integral  equation  ia  aatiafled  by  a  proocaa  a  with  probability 
one,  then  Equation  13)  la  written  In  the  form 

dx  *  f(t,x)  dt  +  g(t,x)  dw(t)  .  (4) 


The  simplified  form  Equation  (4)  la  referred  to  as  a  atochantto  differential  equation  and  is  understood  to  bo 
a  shorthand  notation  for  Equation  13). 


Tha  fallowing  formula  la  naoaaaary  for  the  derivation  of  atoohaatlc  differential  equation!  for  functions  of  , 
solutions  of  other  atoohaatlc  differential  equation!),  Tha  scalar  voralon  of  tha  formula  la  proved  by  Bkorbkhod 
in  Rsfarenoa  B  (p,34ff)l  the  vector  version  follows  quits  simply,  Let  a  satisfy  Equation  (4)  for  t0  <  t  «1  t#‘| 
If  a  scalar  function  <t>{ t,x)  ia  dafinad  with  contlnuuua  second  oroat  partial  derlvatlvaa  with  respect  to  tha  . 

*!  for  t,  <  t  <  t,  and  for  all  x  ,  than  tha  protean  y(t)  =  <£(t,x(t))  aatlaflea  the  relation 


dy 


(B> 


where  3()/3x  denotes  the  gradient  (row)  vector,  B'iVdx*  denotes  tha  Haaslin  (matrix  of  cross  partiala),  and 
the  "star"  danotaa  matrix  tranapoaa. 


1.4  Relation  to  the  Physical  Problem 

There  ere  two  mterfscea  between  the  phyeioel  sltustion  slid  the  usthemtlosl  model  In  the  filtering  problem: 
the  reduction  of  the  dynemics  to  s  stoahistio  differential  aquation  and  tha  interpretation  and  mechanisation  of 
tha  stochastic  differential  aquation  for  the  filter  as  a  computational  algorithm.  Tha  aaoond  lntarfaca  la 
canaldarad  first.  Tha  Interpretation  of  tha  stochaatla  Integral  In  tha  context  of  tha  aatual  estimation  environ¬ 
ment  la  not  at  all  a  trivial  matter.  Tha  filtering  algorithm  will  be  a  finita-dlffaranoa  approximation  to 
Equation  (3),  with  u  represented  by  i  sampled  measurement,  not  a  white-noise,  Tha  problem  of  the  interpretation 
of  Equation  (3)  and  the  approach  to  use  for  the  Integration  ie  discussed  at  length  by  dray  and  Caughey’:  they 
speoify  two  appraechee  end  propose  a  list  of  four  praiaatio  rules  for  chooalnt  between  the  two  approaches  baaed 
on  tha  interpretation  of  Equation  (3).  Another  treatment  of  tha  difference  between  tha  two  approaches  ia  given 
by  Kong  and  Zakal'.  ' 

Tha  real  difference  between  tha  approaches  la  in  tha  choice  of  whether  to  use  tha  ordinary  oaloulue  or  tha 
•toohaatto  oaloulue.  In  the  nomenclature  of  dray  and  Caughey’  tha  former  choice  ia  tha  physical  approach  and 
tha  latter  eholca  la  tha  mathematical  approach.  In  contrasting  tha  two  wpproaohsa,  the  authora  are  quick  to  state 
that  neither  approach  ia  inherently  correct;  the  ohuice  should  be  made  according  to  tbalr  pragmatic  rules: 

(1)  If  g(t, x)  ia  not  actually  a  funotion  of  x  ,  both  ipproaohaa  provide  identical  raaulta, 

(11)  If  the  problea  li  a  strlotly  mathematical  one,  the  aathiMtical  approach  must  be  ueed. 

(Ill)  If  Equation  (I)  le  either  an  approxluitlon  to  or  a  limit  of  the  dlnorete  problem 
[*<W  -  *(tg)]/(tk+1  -  t*)  *  f(tk,i(tk))  +  g(tk,x(tk))  u(tk)  . 

then  the  mathematical  approaoh  must  be  ueed, 

(lv)  If  Equation  (3)  la  slthar  an  approximation  to  a  white-notes  problem  or  tha  limit  of  a  problem  with  abort 
eorrslatlon  time,  than  tha  physical  approach  must  be  used. 

Tha  oemputat lonal  affaot  of  the  dlftarenca  between  tha  two  approaohaa  ia  stated  by  Wont  and  Zakal*  as  follows: 
Let  {•»}  be  a  sequence  of  pieoewlaa  linear  approximations  to  tha  Wianar  procaaa  in  Equation  (10)  such  that 
w*  -  »  ;  than  If  uB}  danotaa  tha  saquanca  of  corresponding  iolutlong,  »n  -  a  ,  whore  a  ia  tha  solution  to 

da,  *  f,<t,x(t))  dt  h  j^ikJ(t,s(t»  (t,x(t))  dt  +  ^g,j(t,a(t))  d«j  .  (8) 


They  state  aona  raairvatl Jia  about  tha  corraotnaaa  of  Equation  (8)  in  tha  vaotor  case,  but  tha  same  form  la  Implied 
by  tha  raaulta  of  Qrv  a,  d  tnugbjy'. 


Tilers  U  alio  i  problem  In  relating  the  atatlntloa  of  tho  ronl  data  to  the  atatlntlcn  of  the  while  uni  an 
uaad  In  the  model;  this  problem  talma  at  both  Interfaces  and  la  really  the  only  one  at  the  first,  for  simplicity, 
consider  the  following  apsclal  cam;  Let  n(t)  denote  a  sequence  of  pulieo  of  width  At  and  of  random  height 
liven  by  a  aauaalsh  dlntrl hut  ton  of  teru  moan  and  variance  cl  .  Tho  autocorrelation  function  for  u  Is  a 
triangular  spike  of  width  ait  and  holght  o-'  ;  the  ares  under  the  aplka  la  thnu  o-Vit  .  It  then  teems 
reasonable  that  the  equivalent  whlte-nolne  ho  specified  hy  an  Impulse  of  weight  u’At  .  The  general  result  la 
at  follows;  If  an  n-dlmcnnlonnl  white-noise  Is  given  by  a  covariance  of  the  form  fi(t)8(t-r)  ,  an  n-dlmnns tonal 
pulau-aequcnos  approximating  the  process  should  bs  chosun  from  s  population  glvon  by  a  covariance  of  fi( t, ; 1 A t 
for  tj  <  t  <  tj  +  At  .  The  oase  of  oontlnuoun  u  le  not  quite  eo  direct,  though  an  equivalent  formulation  enn 
be  obtained  by  using  the  oonoept  of  a  correlation  tlmo  r  ,  whioh  Is  a  time  Interval  such  that  u(t)  can  bo 
considered  unoorrolated  with  u(t+r), 

Since  the  mathematical  model  Is  oonstructod  under  the  assumption  that  the  Wiener  process  has  independent 
elements,  one  final  step  Is  required  to  model  a  noise  with  correlated  elements.  Lot  B( t>5 ( t  -  r  >  bo  the  dealred 
covariance,  which  Implies  Bft)  Is  positive  seml-deflnlte  for  all  t  ,  Then  there  exists  a  matrix  (which  may 


be  taken  as  symmetric)  s'  *  such  that  Bu,(Sl  ’)*  =  a  .  It  dv  §  81,1  dw 
has  the  proper  covariance,  For  nntatlonnl  simplicity  it  msy  be  assumed  that 
g(t,x)  ,  and  the  formalism  of  Equations  (2),  (3),  and  (4)  Is  still  valid. 


If  dv  ~  S1’1  dw  ,  tho  white-noise  dorivod  from 


>t)  la  Incorporated  Into 


3.  DERIVATION  OF  APPROXIMATE  FILTER  EQUATION! 


3.1  conditional  Density  Function 


Let  the  dynseiic  equation  of  tha  system  be  liven  by  Equation  (2),  and  let  the  measurement  be  liven  by 

•I 

y(t)  *  h(t,x(t))  +  r(t)  v(t)  ,  (7) 

•here  h  ii  an  1 -vector,  I  <  u  ,  v  le  an  i-dinennlonal  unit  white -nolle  and  r  In  a  nonelniular  symmetric 
1  a  1  matrix  relatini  the  unit  white-noise  to  the  mpdeled  white-noiee  (equivalent  to  the  matrix  H1''*  Just 
described).  Glnae  the  mathematical  model  esnnot  handle  white-noise  directly,  it  is  aesuaed  that  the  measurement 
is  derived  from  a  process  i  liven  by' 

d*  s  h(t,x(t))  dt  +  r(t)  db(t)  ,  (8) 

where  b  it  an  t -dimensional  Wiener  process.  The  oatheoattcal  model  of  the  eystem  consists  of  the  two  vector 
equations  (A)  and  (8) ,  The  problem  is  to  find  the  minimal -variance  estimate  of  l(t)  ,  ilven  the  process  a(s) 
for  t0  <  s  <  t  ;  that  la,  to  find  tha  •itlsate  i(t)  suoh  that  the  matrix  liven  by 

«( 

is  positive  seml-deflnlte,  where  I  le  any  estimate  of  x  ,  the  prooeseea  are  eveluated  at  t  ,  and  the  symbol 
I  denotes  axpeatitlon. 

It  Is  a  staple  exercise  to  shew  that  the  minimal-variance  estimate  of  a  random  variable,  liven  a  related 
quantity,  la  simply  the  conditional  expectation,  an  that 

*(t)  =  e(x(t)|s(e),  t,  <  •  <  t)  (8) 

and  tbe  problem  Is  to  find  an  equation  for  tht  conditional  expectation. 

The  first  step  is  to  derive  formally  an  expreialon  tor  the  itoohaatlo  differential  of  p(x|m)  ,  the  conditional 
probability  denelty  function  of  x(t)  given  m(e)  ,  t0  <  ■  <  t  ,  It  can  be  ihown  that 

«(a*l  x)p(x) 


whirs  p(x)  la  tha  probability  density  function  for  «(t{)  and 


i  r  f* 

i  -  -  h*r"*b  da  +  b*r"'  dm 

aJt0  Jt, 


Pol  lowing  Buoy',  let  p(xi  i)  £  Q/p  ,  Alio,  lit  |  x)  .  Thin  3  is  aiplloltly  a  function  of  &  and 

p(!)  ,  and  S  la  wxplloitly  a  function  of  a  random  prooeia  t  ilran  hy 

dJ  !  !  hV’h  dt  +  hVl  db  . 

3 


In  addition  puft);  U  a  function  of  t  ,  *hi)a  x(t)  and  t  art  uauDnd  fixed.  Then,  utim  Equation*  (B) 
and  (12). 

dq  *  at  +  h*r ' ah  dt  *  hV‘  dbj  ♦  h*r'“h  dt  ,  (1 


ft""  it  p^ft^  +  8  B  Cq 

»her*  C  ii  the  foieerd  dlffueion  op*r»tor 


^v-3(fti)  +  1  ^  yi) 

***1  *  i^, 


3q  a“q 

«  — --  e  ft 

»  3*«  * 


•ubxtltutln*  Equation*  (14)  tnd  (16)  into  Equation  (19)  provide* 


dq  *  £q  dt  +  q(h*r*‘h  dt  +  hV‘  db) 
«  £q  dt  ’+  qh*r'*  d*  , 


U* lm  Equitlon*  (16)  *nd  (16),  *nd  th*  definition  of  q/P  , 


dp  *  d  ^  q  d»^  a  J*  (dq)  d* 

«  P  .  fl  J  (S)  d,  dt  ♦  J  ?  h*V*  d*  di  > 

■  Ph*r"‘  di  «  P?r'*h  dt  +  Pi* r'1  db  . 

Uitm  Equation  (8),  with  *4p,  <t>  4  P'1  ,  fiph*r'*b,  «4Pb*r*1,  and  lib, 

d(P'1)  «  -  p‘l  h*r-,(h-l!)  dt  -  P‘l  h*r*1  db  , 

Pinatly,  uilm  Equation  (11)  with  x  4  (P"‘,q)*  ,  <t>  4  MP'1  ,  *4  (-P’1  h*r''(b-B)  ,  £q  +  qii*r’*)* 
I  4  l-P’1  h*r*1,qh*r*1)*  ,  and  *4b, 

d  I  *  fi  fSj  f  h*r'4b  5^dt  +  b*r_1  /Sj  db  -  p*  r’Vh-fi)  ^  dt  - 


-  h''  r*1  db  -  I?  r"1,(p)  dt 


£  dt  +  (h-K)*r'*  (dt  -  b  dt)  , 


Let.  4>  be  *n y  aoelar  munition,  t»lc*  contlnuoualy  differentlabla  In  x  : 


<?  *  J  0(x)p(xl*)  dx 
d $  ■  J  <£(x){dp(*l*>)  dx 

"i»* 
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SubstHutlh*  liquation  (19)  into  (30)  providaa 


*  J  4>(i)  (C  p(x|  a)  +  (h-ii)*r",p(x|n) (da ~fi  dt))  dx  . 


Ut  C  d*not»  th*  foraal  adjoint  o f  G  , 


Then  Equation  (31)  becotaea 


la  1  *  1 1  Ja  1  1  J 


tip  -  dt  +  #ih  -q?h)*r**(da  -  fi  dt)  . 


3.1  Approximate  Filter  Equations 

Tha  uaa  or  Equation  (33)  aa  a  differential  equation  of  x  results  In 

dx4  «  ?!  dt  +  (xjh  -  x1{i)*r,<da  -  £  dt)  ,  (34) 

which  ll  not  vary  praotloal  baoauaa  it  ,  fi  .  and  xjh  ara  eaadad  oontlnuoualy.  Aa  tha  flrat  atap  in  tha 
approtlnation,  lat  f  and  h  ba  approxlaatid  by  a  mcond-dairaa  axpanalon  about  *  -  5  j  alao,  for  notatlonal 
ilapllolty,  auppraaa  tha  explicit  nv  iranea  of  t  aa  "n  ar lucent  of  f  ,  i  ,  and  h  ,  alnoa  thalr  dapandenoa  on 
tlaa  1*  lnoldantal  to  tha  followlni  r  .nipulatlona,  Then,  adoptlni  tha  lunation  convention 

fi(i)  v  ',(S)  +  flj’tiUij-i.)  +  ?  fjHi<»)(Xj -4J)(xk-!k)  ,  (38) 


8  $  -  '»!  « • 


A  alailar  axpraaalon  holda  for  h  ,  Prop  equation  (38), 


IjU)  3;  fj(i)  +  i  fjJi(S)(*j -xj)(xk-xk) 


ahara  (ij  -SpU*  -xk)  la  tha  conditional  oovarlanoa  of  x  and  la  danotad  Pjj 


■lallarly 


Xlfj(*)  St  fjjMft)^!  +  «iV*> 


Ualni  Equation*  (38)  and  (37'  for  f  and  h  In  liquation  (34)  prnvida* 

dit  at  tt(i)  dt  +  i  f{#(S)PJt  dt  +  Pijb^lSjrj}  [da,  -  (h.(S)  +  ?  Mj£(J)P„)  dtj  .  (38) 

Tha  aaxt  atap  la  to  find  a  dlffarantlal  aquation  for  P  .  In  lanaral,  ovan  with  a  saeond-dwirat  axpanalon 
for  tha  nonllnaarltlaa,  an  Inflnlta  aaquanoa  of  dlffarantlal  aquationa  la  raquirad,  baoauaa  all  tha  aoaenta  ara 
naadad  to  daaarlbo  too  oondltlonal  density,  Howiver,  by  aaauainl  an  approprlat*  fore  for  p(x|  a)  ,  tba  aaquanoa 
jtopa  at  P  ,  Tha  flrat  aaauaptlon,  ustd  by  Buoy*,  la  that  third  and  fourth  central  conditional  aosanta  ba 
nailavtad.  In  lohaarta  and  Baas*  it  la  shown  that  tba  aaauaptlon  la  raiaonabla  for  a  distribution  with  aoat  of 
tha  probability  aaaa  sufficiently  oloaa  to  tha  Man,.  If  It  la  asiuaed  that  p(x|a)  la  Oauialan,  tha  aaquanoa 
alao  stop*  at  P  ,  and  thara  la  do  raatriotion  on  tba  alia  of  tba  aosanta. 

■too*  Pjj  om  ba  written  (xjij -Sjij)  ,  dPjj  la  derived  in  two  parts.,  Ut  4*  XjXj  and  uaa  Equation  (33)  to 
find  dxjxj  .  flinoa 


C*i*j  *  fl*j  +  Vl  +  «lk«jh  • 


It  folloaa  that 


dx^li  «  f^x,  dt  +  fjxt  dt  +  l^lja  dt  +  (x^xjl\  -  x^x. 4)rkf(da,  -fi,  dt)  . 
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dx  x 

(PI)  —  - - 7+  v 

dt  t  +  x1 


(Mil)  y  -  tan*1  x  +  * 

(M12)  y  3  *  +  » 


where  v  and  w  ere  white-noleea,  11th  either  imeuremont  lohune,  (Mil)  or  (MIS),  the 
•xletenox  end  uniquenon*.  The  eocotid  oyetrui,  which  dooe  not,  In  fivmi  by 


overall  hM . HttU"f1"” 


(Da) 

dx  , 

—  =  -  x3  + 

dt 

(M21) 

y  -  x  +  x1 

(Maa) 

y  -  x +  w  . 

1 1 1  |i)i  uh  In 

The  filtering  acheeei  ere  outlined  below,  For  the  outline,  f  end  h  ere  the  eyeten  nonllnrn  »nd 

(quetlone  (3)  end  (7).  The  white-nolee  prooeete*.  v  end  w  ,  ere  eeiuaied  etetlonery  with  covn ,,'  lri|l(il,  „f  x  , 
o-i  reepectiveiy  eu  t.het  t  s  av  end  r  =  »,  ,  The  euheorlpt  "n"  denotee  nominal,  i  le  the  nn  ■  ’  ||(  (mi3) 
p  le  the  approximate  ooverlenoe,  end  e  print  denote*  differentiation,  Fate  thet  for  linear  im'iimu'1 
end  (Mai),  certain  tern*  venlih  end  there  ere  only  three  different  filter*. 


1,  Linear 

The  linear  fllterini  algorithm  oen  be  applied  to  e  eet  of  equation!  lineerieed  about  an  a  prior 
The  equation!,  derived  by  Kelnen  end  Buoy11  ere 

-  «  tii  +  <rt*vKto -Kb 
5t  "  , 

a.  Quul-htoiunt  Sllnital-Varianci 

Thle  le  the  filter  derived  by  Bohwert*  end  Been",  eno  independently  by  Fleher', 

«  f(i)  +  ^  f"(*)p  +  o-;*ph'(S)(y-h(i)  - i ph" (8)]  . 


—  =  apf'  (x)  -  crjVb'  *(*)  +  <r:*p’h"  (X)  [y  -  h(x)  -1  ph"  (I)]  +  <r’ 
dt 

9.  Truncated  Minimal -Varianet 

Thle  le  the  filter  derived  by  Baee,  Norun,  end  Sohwerti10, 
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f(S)  +  1:  f"(i)p  +  cr,J*ph' (S>Cy - h(S>  -iph"  (x)] 


77  ■  Jpf'(S)  -  «5*pV(*>  -  iajVh"(x)[y-h(x)  phH(i)]  +  crj  , 
dt 

t,  Modified  Minimal-Variance 

Hrivlnd 

Hie  filter  le  a  oonpronlee  between  iquetione  (38)  and  (40  >  which  ii  beeed  on  difference  in  the  tho 

In  the  p  aquation.  By  droppin*  the  drlvini  tern,  the  filter  le  linpler,  yet  the  reeponee  fell*  ' 
reeponeei  for  the  two  preoedlej  filtere, 

f(!)  +  t  f"(x)p  +  a’i’ph'dlty-hfx)  -t  ph"(i)] 
dt 

77  w  3pf'(x)  -o-;,p,h',(x)  +  <t\  . 
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#.  'Maximum-Principle  Letu t  Square/ 

ThU  filtor  is  dorivsd  by  Dotchmondy  nnd  Srldhar11  for  minimizing  an  ilitegml-aquiiro-estlmatlon-orror  criterion, 
using  dstsrministio  technique.'  tty  the  use  of  Pontrlngin' *  maximum  prlnolplo  thu  minimization  1b  "reduced"  to  b 
two-point  boundary -veluo  problem  which  la  solved  hy  an  Invariant  imbedding  toohnlque  lining  an  approximation  to 
one  boundary  condition. 

f(i)  +cr;’ph'(«)[y-(i)) 


3pf'(i)  -  <r;Vh''(8)  +  <o;Vh"(S)[y-h<8)]  +  cr®  .  (43) 


Actually,  Equation  (43)  la  a  special  case  of  the  derivation  in  Uotchmendy  and  Sridhar11:  thuy  used  arbitrary 
•sighting  functions  In  the  criterion  Integrand,  while  Equation  (42)  corresponds  to  the  particular  sot  of  wnlghtlnn 
functions  that  result  in  thu  Knlmun  filter  for  l.lnaar  dynaitiicu. 

6.  Dynamic  Programing  Least  Squares 

This  filter  is  derived  by  Cox11  for  a  oriterion  which  ie  similar  to  that  uaed  for  the  previous  filter,  Tha 
minimisation  la  effected  by  dynamic  programming  using  a  quadratic  approximation  to  tha  ooat  function. 

=  f<«)  +  tr"'ph'  (5)  r.v  -h(x)] 
dt 


dx 

—  ■ 

dt 

dp 

dt 


-7  »  2pf'(i)  -tr;*p*h'*(li)  +cr*  ,  (43) 

dt  * 


A  look  at  Equation  (43)  shows  that  this  f Altar  la  aaaentlally  equivalent  to  using  linear  flitaring  about  the  com¬ 
puted  mean,  a  technique  that  had  been  rood  heui-Utleally  previously. 

7.  Diecrete-Meaeurement  Minimal-Variance 

This  filter  ie  derived  by  Jaiwiueky1*  for  a  mlnimal-varienoj  oriterion  under  the  aeaumptlon  that  tlu  measure¬ 
ments  arrive  at  isolated  instants.  Tha  form  preaantad  hore  i*  the  limiting  form  for  continuous  measurements. 

■  f<Sl)  +  *f''(a)p  +  (ri'ph'tilty-Mi)] 

dt 


—  ■  3pf'(a)  -  tri’p'h'Vx)  -  fc^*h"(8)[y-h(S)]  +  exj  .  (44) 


Slnos  ths  svolution  of  ths  systsm  itsslf  is  ocnsidsrsd  oontlnuous,  ths  portion  of  ths  equations  rslstsd  to  updsting 
tbs  aatlmsts  in  ths  absanoe  of  msuursnsnts  sgrsss  with  Equations  (38),  (40),  and  (41).  Ths  loss  of  ths  tsrai  in 
b"(J)  is  dus  to  ths  dlffsrsnos  betwtan  ths  physical  and  mathsmstloai  approaches  dlsousssd  in  Oeotlon  3.  In  ths  ■ 
dsrivstlon  of  Equation  (44),  Jazwlnsky  usss  ths  spproxisstion  to  ths  conditional  density  that  U  uaed  to  dsrlvs 
Equation  (40). 

(.  Modified  Discrete-Measurement  .Minimal-Variance 

This  filtsr  is  related  to  Equation  (44)  in  ths  anew  way  that  Equation  (39)  is  rslstod  to  Equation  (40),  i.s., 
ths  conditional  dsoslty  is  taauaad  to  bs  oausaUn. 


—  ■  f(J)  +  if"(i)p  +  <r;*ph'(i)[y-h(i)] 


—  ■  3pf'(i)  -  o;,p,h',(i)  +  tr;*p,h',(i)[y-h(i)]  +  cr^J  .  (45) 


Ths  application  of  Equations  (38) -(45)  to  Equations  (35)  and  (37)  la  straightforward  and  is  not  oarrisd  out 

hers, 

Ths  ooeputsr  program  uaad  for  ths  simulation  study  lnoludts  s  simple  rsottngulsr-rule  integration  with  constant 
stap-siss,  Ths  use  of  constant  step-size  allows  seal)  filter  to  be  cusiparud  on  ths  basis  of  the  same  pseudo-random 
eequenoe,  The  random  number  generator  is  s  cmblnatlon  of  a  standard  uniform  random  asquenoe  routine  plus  an 
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approximate  trails  format  Ion  to  n  Onus*  tan  random  sequence.  Tha  program  has  two  modes  of  oporutlon:  In  oito  mode, 
only  a  single  estimation  la  made  with  a  prc-spccified  initial  condition  for  tho  ntato;  in  thn  otlior  mode,  several 
runs  are  made  for  random  initial  conditions,  and  the  statistics  of  the  estimation  errors  are  computed.  The  output 
from  the  program  la  a  computer-prepared  plot  showing  the  tlmo-hlstory  of  tho  filter  response  or  tho  error  statis¬ 
tics.  The  plots  show  ovory  20th  point  with  linonr  interpolation  between. 

4.3  Results 

At  noted  earlier,  the  simulation  study  was  not  intended  to  be  a  complete  Investigation  of  tho  computational 
characteristics  of  nonlinear  filters,  Two  standard  ensrs  wore  used,  whioh  were  computationally  docllo  when  used 
with  the  step-size  chosen.  For  both  dynamical  equations  (Dl)  of  Equntion  (39)  and  (D3)  of  Equation  (31),  the 
standard  run  consists  of  5000  points  o  001  socond  apart  for  s  total  problem  time  of  five  seconds,  with  crj  =  l 
and  #{  »  10  .  Only  tho  Initial  condition  dlffors.  Figures  1  and  2  show  the  state  *  and  tho  measurement  y 
for  the  two  standard  cases.  Tho  figures  show  t lie  nonlinear  measurement,  hut  tho  noise  Is  so  large  that  there  Is 
not  too  much  apparent  difference  between  the  linear  nnd  nonlinear  measurement 

In  tno  rosponse  to  the  standard  inputs,  there  is  n  large  difference  hotween  thn  response  of  tho  linonr  systems 
and  the  nonlinear  aystoms,  while  tho  various  nonlinear  systems  ate  remarkably  similar.  Figures  3  mm  d  show  the 
estimation  irror  for  thn  two  standard  cases.  As  might  be  expected,  linear  measurements  help  the  linear  systom. 

What  might  not  he  expected  la  that  the  relatlvo  error  performance  nf  the  nonlinear  filters  within  the  shaded 
region  Is  different  for  the  two  oases,  To  show  that  tha  results  in  Figure'  1  and  4  are  not  peculiar  to  the  par¬ 
ticular  initial  condition  and  pseudo- random  sequences,  three  representative  filters  were  chosen  for  a  set  of  ten 
runs.  The  mean  and  mean-square  errors  are  shown  in  Figures  5  and  8  for  initial  condition!!  with  variance  one  for 
the  first  case  and  variance  1/4  for  the  second  case.  It  oan  bo  aeon  that  the  error  statistics  are  still  quite 
oloao,  practically  Indistinguishable  from  a  mean-square  error  point  of  view.  Moreover,  the  relative  error  per¬ 
formance  of  the  chosen  filters  Is  qualitatively  unchanged. 

Walla  on  the  topic  of  statistical  runa,  It  In  lntareatlng  to  note  the  comnarlaon  between  the  output  nf  the  p 
equation  for  an  Initial  aondltlon  of  one  standard  deviation  aim  the  mean-square  error  for  tsn  runs  for  one  oase, 
aa  shown  In  Figure  7  for  filter  2.  dynamics  Dl,  and  measurement  Mil.  Moreover,  It  was  found  that  the  change  In 
the  mean-square  error  for  a  larger  number  of  oases,  up  to  80,  while  noticeable,  was  relatively  small. 

The  effects  of  changing  the  statistics  of  the  random  sequences  are  similar  for  all  the  filters,  and  are  intui¬ 
tively  eajonabls. '  Changing  cry  has  little  effect  on  the  initial  responre,  though  the  higher  <rv  the  worse  the 
ultimate  following,  contrariwisa  increasing  a,  slows  the  response  noticeably  without  affecting  the  ultimate 
tracking.  Tha  error  responses  for  filter  2  with  C  and  MU  aie  shown  in  Figures  6  and  8. 

The  runa  demonstrating  the  oorreetneaa  of  the  noise  model  show  the  effects  of  Improperly  matching  the  riltsr 
parameters  tu  the  noise  atatistics.  The  effeot  of  the  mismatch  oh  x-i  and  p  is  shown  in  Figures  10  and  11, 

For  all  the  curves  uhowu,  tho  actual  pseudo-random  Inputs  ware  taken  from  Identical  populations:  only  the  filter 
parameters  varied.  Evidently  a  statistical  mismatch  esn  seriously  affect  the  performance  of  the  filter.  It  also 
appear!  that  the  value  of  p  generated  by  the  i liter  la  a  good  index  of  the  performance,  even  when  the  statistics 
era  poorly  matched. 

The  flnnl  aapeot  studied  cn  the  computer  was  ilia  effect  of  sampling  the  data.  Two  approaches  to  sampling  were 
considered:  aample-and-hold  and  pulre  sampling.  For  the  sample-and-hold  runa,  the  effective  noisa  variance  was 
obtained  using  a  At  equal  to  th„  sampling  period,  rather  than  the  computation  Interval.  For  the  pulst-sampllng 
runs,  aj1  waa  made  zero  fur  thoee  Intervals  during  which  no  measurements  were  made.  Both  types  of  sampling  wore 
applied  to  filter  2  with  dynamics  Dl  and  measurements  Mil,  The  response  plots  are  shown  in  Figure  12.  An  suould 
be  expected,  sampling  la  detrimental  to  tha  initial  rosponse  of  the  filter,  though  ultimately  the  estimate  settles 
In  to  the  proper  vslue.  From  the  one  eaee  considered,  sample-and-hold  appears  somewhat  better  than  impulse  sam¬ 
pling,  whleh  may  be  due  to  the  smoothing  effsot  of  the  zero-order  hord. 

Theie  Is  one  problem  In  mechanizing  the  filters,  which  has  not  yet  been  discussed,  that  requires  much  more 
Invest 'gat Ion:  the  effects  of  the  filter  parameters  and  the  step-due  on  computational  stability,  For  some  com¬ 
binations  of  parameters  <ry  and  o-,  and  initial  covariance  p(tc>  ,  the  itep-slze  must  be  made  small  to  stabilize 
tha  couputation  during  the  initial  portion  of  the  run.  The  reason  for  the  lnstpblllty  is  the  large  value  of  the 
derivatives  and  tha  consequent  large  truncation  errors  introduced  in  the  Integration.  A  particularly  Insidious 
form  of  computational  Instability  arose  In  thq  course  of  the  slmulatioiVstudy:  it  ts  possible  to  be  In  a  condi¬ 
tionally  stable  region  ouch  that  one  pseudo-random  sequence  with  a  given  statistical  description  results  in  s 
stable  response,  while  another  sequence  drawn  from  the  same  population  does  not. 

Apparently,  nonlinear  filtering  is  superior  to  linear  filtering,  although  no  one  nonlinear  filter  offers  any 
clear-cut  advantage  over  any  other  from  a  performance  point  of  view  for  the  problem  considered.  It  also  appears 
that  the  filters  derived  from  a  continuous  model  ore  quite  smenable  to  samplod-riata  use. 
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CHAPTER  8  -  LINEAR  SMOOTHING  TnCIINI«UK9 
(POST-rUOIIT  DATA  ANALYSIS) 


Herbert  E.Rauoh 


1.  INTRODUCTION 


1.1  Background 

BlnoG  the  time  of  Gsuhb1  people  hove  btien  interested  In  th*  problem  of  lia»t-squ»rea  estimation.  Cause  not 
only  formuletod  the  estimation  snd  devised  s  technique  for  solvins  it  (a  sequential  algorithm  nailed  Gaussian 
elimination,  which  is  used  on  modern  computers),  but  he  applied  this  to  determine  the  orbit  of  the  asteroid 
Ceres,  The  limitation  on  his  solution  was  that  it  only  applied  to  the  case  where  the  system  to  be  estimated  is 
deterministic  and  the  errors  on  the  individual  measurements  are  unoorrelated,  When  a  system  is  deterministic, 
its  evolution  oan  be  completely  specified  from  the  initial  conditions  and  the  differential  equatlomi  of  tho 
eysteu,  Celestial  bodies  obey  Newton* e  law*  of  motion  end  disturbing  force*  duo  to  other  aeleitlel  bndiee  ere 
knowu  to  m  reseontble  degree  of  tooureoy,  eo  for  practical  purpoiee  their  motion  can  ha  oonaldered  determlnietlo. 
Terreatrlel  bodies,  on  thw  other  hand,  ere  subject  to  disturbing  fore**  whoa*  effeota  cannot  ha  daacrihed  exaotly 
bsforehand  although  thalr  statistical  properties  night  ba  known,  When  a  system  is  described  by  differential 
equation*  eubjeot  to  disturbances  which  are  aUtietloally  tine-varying,  tha  system  can  bt  uillsd  s  stoohsatlo 
prooass. 

Tha  pionesr  work  of  Wiansr1  discussed  and  solved  the  problem  of  linear  lsamt-mquarsi  estimation  for  stoohustlo 
proosssts.  Howsvsr,  his  rasults  wars  mainly  for  stationary,  non-tima-varying  gyitsms,  and  thara  wag  goma  diffi¬ 
culty  In  obtaining  numsrlogl  aniwtrs  for  largs  order  ayatwaa,  Many  pacer*  hava  sppsarsd  slnos  then  giving 
dlffsrsnt  solutions  to  the  problem  under  mors  gsnsrsl  conditions,  The  most  widely  .used  solution  for  filtering 
■nd  prediction  is  that  of  Kalman*1*  and  Buoy1 ■*,  The  primary  advantage  of  their- solutions  is  that  they  apply  to 
tlms-vsrylng  systems  and  the  aquation*  which  specify  the  optimum  flltsr  a re  in  the  fora  of  reoureivw  difference 
, equations >wbi»h  have  obvious  computational  advantages.  However,  Kalman  and  Buoy  did  not  ooneldar  the  important 
problem  of  smoothing.  Filtering  tliows  on*  to  estimate  prsesut  value*  of  the  variables  of  interest  using  present 
date,  while  smoothing  allows  one  to  estimate  put  values,  A  number  of  papsrs  have  presented  different  derivations 
of  rwauraive  solutions  tor  tha  smoothing  golutlon  from  dlffsrsnt  points  at  view  for  both  dieorets  and  continuous 
syataas,  Bryson  and  rramlor'  gave  on*  of  th*  first  recursive  solution!  for  continuous  systems  using  the  calculus 
of  variations  and  tha  msthad  of  muimum  likalihaod.  Similar  solutions  with  some  sltsrnstivs  forms  wars  given  by 
Cog*  using  Dynaaio  Programming,  Raueh,  Tung  and  Striabal*  using  dliorste  time  manipulations  of  Bayes's  rule  and 
the  method  of  Mmslaum  Likelihood,  Us19  using  th*  oaloulus  of  variations,  endMidltoh11  using  projootion  argument*, 
Two  nor*  reosot  remits  were  by  Fraser1 1  who  expressed  ths  solution  es  the  comb  Inst  ion  of  two  filtered  estimates 
from  a  forward  and  backward  Kalean-Buoy  flltwr,  and  Kallftth  and  Frost1*'1*  who  made  use  of  an  innovations  approach 
to  llnssr  smoothing.  In  their  papsrs  Kallath  and  Frost  also  give  in  interesting  summary  of  work  in  filtering  and 
smoothing  with  a  Hat  of  uvar  forty  references, 

Obvlouiily,  all  thsas  aolutlona  should  ultiutsly  give  ths  asms  answer  to  ths  asm*  problem,  but  th*  different 
derivations  glvq  insight  into  ths  rtasoni  for  different  rssurslvs  farms  of  tbs  smoothing  solution.  For  deter¬ 
ministic  wystsms  with  linear  equations,  ths  solution  simplifies  considerably  bsosuss  ths  smoothed  estimate  of 
put  val'.n.s  la  obtained  directly  from  the  filtered  eetimet*  of  th*  lateet  value  by  integrating  th*  differential 
equations  of  motion  backward*,  For  linear  smoothing  of  itoohaetlo  systems  s  similar  procedure  can  be  used  in 
which  differential  equation*  are  .integrated  backward*,  etartini  with  th*  latest  filtered  estimate.  However, 
there  are  additional  Inputs  to  ths  differential  equations  involving  earlier  filtered  estimates  or  msuursmants, 
depending  on  the  form  of  th*  eolutioa.  The  purpou*  of  this  presentation  is  to  outline  ths  procedures  and  solutions 
whloh  oan  be  used  in  ths  linear  smoothing  problei  ind  to  icdisits  how  thw  results  oan  be  applied  to  s  problem  in 
post-flight  data  analysis  whioh  involves  tracking  a  satellite  disturbed  by  stoohutlo  dreg  forms11. 


1.1  Notation 


.  In  general,  lour  ou*  letters,  euob  as  u ,  v ,  *  .  end  a  ,  will  denote  eolumn  vectors  while  upper  case  letters, 
such  me  A  ,  B  ,  F  ,  0 ,  and  $,  will  demote  metric**.  Tbs  letter  1  represent*  th*  Identity  matrix.  The  super¬ 
script  prims,  as  in  A'  or  u'  ,  will  dsnots  tha  transpose  of  ths  matrix  or  tbs  transpose  of  s  column  vector 
(which  becomes  a  row  vector).  Th*  product  of  a  column  vector  and  a  row  vsotor,  suoh  as  xs'  is  a  matrix.  Th* 
symbol  1  represents  sipsotsd  value  so  that  it  A]  represente  th*  expected  velu*  of  th*  quantity  A  .  Th*  super¬ 
script  -1  u  in  A*1  ntans  ths  inverse  of  th*  matrix  A  .  in  all  cues  it  will  b*  assumed  that  ths  inverse  of 


ths  matrix  exists,  although  quit*  often,  th*  invars*  cm  be  replaced  by  a  di 
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isudo-lnvers*  or  generalized  inverse 


1.3  'Linear  Estimation 


for  tho  disorets  version  of  ths  linear  •■filiation  problem  tha  «y»tam  to  bo  •atlaat«d  can  bo  deeoribsd  by  tha 
following  set  of  matrix  dlffaranca  equation*: 

*kai  “  +  UX  *or  k  e  ^  ®  ■  •  • •  i  N  i  (1.1) 

Th*  llnitr  E0uuraB«nta  obttlnad  from  the  ■rates  art  given  by  another  get  of  metrlx  equation!, 

s  Hkxk  +  vk  for  k  =  1,3 . N.  (1.2) 

The  vector  x  repreaonte  the  etate  of  the  ayiten  which  In  to  be  estimated  while  the  vector  a  represent*  the 
known  measurements,  The  veotore  u  and  v  ere  hot  known  exactly,  but  they  are  aero  aeon  independent  random 
varlabloe  with  known  covariance.  The  variable  u  repreeenta  random  olianpns  In  the  etato  (dynamic  nolle)  while 
the  variable  v  repreaenta  random  change*  In  the  meaaurenenta  (measurement  nulne),  The  eubeorlpt  k  represent* 
the  value  of  the  quantities  at  the  time  of  the  kth  meaaureuent,  If  tho  dynattio  nolee  u  la  identically  zero 
for  all  time,  the  eyateo  le  said  to  be  deterministic.  The  matrices  'f1  (transition  matrix)  and  II  loutput  matrix) 
represent  knuwn  quantities  which  can  oliange  from  one  measurement  to  the  next. 


Mast  physical  system*  will  Involve  uonllnetr  equations,  but  It  la  assumed  the  above  act  of  linear  equations 
eon  ha  obtained  by  Unearlmlni  about  aome  nominal  value*  for  th*  *tet«  and  the  measurement*.  It  may  bo  that  th* 
phyaloal  ayetea  la  governed  by  a  eet  of  linear  (or  linearized)  differential  equation!  rather  than  dlffarenoa 
equations,  although  th*  asanurements  will  tabs  place  at  dlacreta  tiros.  In  that  caa*  the  original  system  differ¬ 
ential  equation!  suit  be  integrated  to  obtain  tha  required  difference  equation  relating  tha  chenge  in  etate  from 
one  meeeuremeut  to  the  next.  Conversely,  under  oartaln  condition*,  in  the  limiting  oeee  ea  the  time  between 
■eesureiente  goes  to  aero,  the  dieorete  eyetem  will  tpproaoh  i  oontinuoui  eyetem, 


The  optimum  eetlsate  will  be  the  linear  eetlaate  whloh  mlnimlnai  th*  neon  square  error,  calculating  th* 
•atlmta  requires  knowing  the  mean  and  aovarlnnae  of  all  th*  random  variable*  of  Interest,  but  no  higher  numentn, 
If  all  th*  random  nriabltm  hnvi  a  normal  probability  distribution,  tha  iitimate  will  be  tha  conditional  naan  of 
the  atate  given  the  measurement*,  Sometimes  the  eet'imate  ie  aleo  celled  the  Maximum  Likelihood  estimate  because 
it  maximizes  th*  conditional  probability  distribution. 


Let  n,/k  denote  the  optimum  estimate  of  the  etate  x,  given  all  the  aeeeurementa  up  to  ik  ,  It  J  le 
greater  then  or  equel  to  k  ,  It  le  called  filtering  and  predlotlon.  It  j  ie  lea*  than  k  ,  It  le  called 
smoothing,  The  optimum  filtering  eolutlon  ae  derived  by  Kalman,  can  be  written,  where  B  le  the  matrix  gain  on 
kb*  Kalman  filter, 


*kei/k  *  *kn/k*k/k-i  +  8lk 
\  s  *k  •  \Wi  • 


(l.S) 


The  Initial  conditions  for  the  filtering  solution  are  beied  on  the  a  priori  information.  The  quantity  Bk  ,  whloh 
contains  the  new  information,  la  th*  difference  between  the  actual  measurement  ik  end  the  beet  set  baste  of  the 
aenmurement,  Thle  quantity  will  ploy  on  Important  part  in  the  derivation  of  the  smoothing  solution. 


The  above  filtering  eolutlon  In  recursive  in  the  sense  that  tbn  denirnd  estimate  tm  calculated  sequentially 
from  previous  estimates.  The  emoothing  solution  otn  alio  be  written  In  n  recursive  form  end,  In  fnot,  four 
different  recursive  versions  of  the  smoothing  solution  will  be  preeented  here,  In  theory,  thee*  four  versions 
will  give  ldentlonl  results  but,  due  to  euoh  thing*  **  computer  programming  or  running  time  or  the  effect  of 
roundoff  errors,  one  way  may  be  superior  to  another  for  e  particular  problem. 


The  first  version,  onlled  fixed  point  emoothing,  Is  useful  when  it  in  ncueseary  to  calculate  the  smoothed 
estimate  at  only  oat  point.  For  instance,  the  smoothed  eetlaate  uf  only  the  Initial  condition*  of  th«  ntats 
sight  be  desired.  The  form  of  the  solution  tor  fixnd  point  (soothing  in  lialliu1  to  that  for  filtering  as  shown 
below,  where  the  matrix  gala  B  le  a  general  flighting  ooeffloinnt: 

K/h  "  ®k/*-i  + 

The  second  version,  nmoothlng  using  filtered  estimates,  hoe  two  ports.  First,  the  Kalman  filtering  solution 
ie  ueed  to  prooeee  the  seenuremente  sequentially,  In  th*  order  In  which  they  were  reoeived,  to  obtain  the  filtered 
estimate  (forward  eweep).  Second,  the  naoothlng  solution  in  used  to  process  tSe  filtered  estimate  a  second  time, 
la  reverse  order,  from  the  last  to  the  first,  to  obtain  th*  smoothed  estimated  (beokward  sweep),  The  initial 
condition  for  the  backward  sweep  in  the  filtered  eetlaate  of  th*  etate  at  the  rinal  tlae,  which  Is  alio  the 
smoothed  eetlaate  of  the  state  at  that  time.  The  fora  of  the  solution  for  nmoothlng  with  filtering  ie  shown 
below,  wbsrs  the  matrices  A  and  B  or*  gensrsl  wtightlag  oosfflalentr 

®k/N  *  Aik»i/*  +  s8k/k  • 

There  in  an  alternative  aetbod  In  which  t.b*  backward  sweep  involves  meecurenentn  Instead  of  tbs  flltsrsd 
satlmatsa,  This  ie  the  third  version,  which  In  oalled  swoothlng  using  weuureaente.  The  rtaurnlve  solution  onu 
be  written  iohewatlatlly  u  shown  bwlow,  where  the  veotor  wk  ie  eleo  ueloulsted  reourslvely: 
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The  fourth  version,  celled  fixed  lag  umootli ing ,  can  bo  uaoil  whon  It  li  desirable  to  smooth  for  a  flxad  number 
of  measurements.  The  raeurilvt  aolutlon  lnvolvoa  both  fllturod  aatlmtee  and  meaaurementm: 


i, 


kH/NU 


%/N 


n*i  +  c*k/k 


1.4  Outline  of  Mark 


The  remainder  of  thia  praaantatlon  examinee  the  smoothing  aolutlon  for  the  diaorate  system  (Section  3)  and  tho 
continuous  system  (Section  3),  and  applies  it  to  a  problem  in  aatalllte  tracking  (flection  41.  It  la  nhown  that 
the  optimum  estimate  for  the  discrete  system  must  satisfy  the  sampled  Wlennr-tlopf  equation  and  an  Innovations 
approach  la  used  to  derive  a  solution.  The  Innovations  approach  presented  here  does  not  have  the  genorallty  and 
the  elegant  aathomatioe  of  that  of  Knllath  and  Croat11,1*,  but  It  uses  some  of  their  ideas,  four  different 
versions  of  the  smoothing  solution  and  the  aenouUted  cover lnnoe  are  presented. 


Tho  relations  between  tho  discrete  a.vstom  and  the  continuous  system  are  axamlnod  und  the  continuous  smoothing 
solutions  are  preaented  as  the  Halting  one*  uf  the  diaorate  ones,  finally,  a  problem  Is  outllnsd  involving  t 
etoohsstio  nodal  for  satallita  drag,  and  the  smoothing  aolutlon  1*  applied  to  actual  data. 


a.  discrete  time  smooth ino 


1.1  'Statement  of  the  Problem 

The  system  to  be  estimated  la  deaoribtd  by  a  eat  of  matrix  difference  equation!, 

*k»i  *  *knxk  +  “k  ,or  k  “  1.  S....N. 

The  aeaaurementa  obtained  from  the  ayitem  are  defined  by  the  equations 

"k  "  Hk^k  +  vk  tar  k  1 1  3  i  ...  N  , 
an  nxl  column  vsetor  of  state  variables  . 
an  nx  1  column  vector  of  a. -stem  Unput)  uncorrslatsd  dynamic  noise 
an  r  x  1  column  vector  of  measurement  (output)  uneorralatsd  noise 
olumn  vector  of  known  Masureaantt 
the  nx  n  transition  matrix  with  known  coefficients 
rx  n  matrix  with  known  coefficients. 
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(3.3) 


where 


xk 

a 

%n 

nx  1 

“k 

a 

An 

(lx  1 

vk 

- 

an 

ml 

\ 

w 

An 

r  x  1 

X 

th« 

nx  n 

\ 

x 

an 

r  x  n 

The  dimensions  of  the  measurement  i.  can  vary  from  point  to  point  me  long  as  the  dimensions  of  the  associated 


vectors  end  matrices  also  very  accordingly.  The  vectors 
variables  with  asm  mean  and  a  known  aovsriance. 


uk  and  v„  represent  vector -valusd  lndspandsnt  random 


KUgUj)  =  \ 

«Vj'  =  Rg 
«<Vj>  *  0  ■ 


If 

it 


=  J 

=>  J 


and  asro  otherwlss 
sad  aero  otherwise 


(3.  a) 


In  some  treatment, ■  of  this  problem,  It  la  assumed  the  vectors 
slight  modification  will  be  disouaead  later.  The  matrices  Q 


Uj,  sod  vk  ere  correlated  If  k «  J 


This 


and  R  could  be  singular  and  the  implications  of 


this  trs  also  dloouaaed  later,  although  for  the  time  being  it  will  be  ueumed  both  matrloes  are  uon-singulmr. 


In  any  real  estimation  problem  there  ie  an  Important  distinction  between  n  priori  information  and  actual 
msasurementa,  However,  In  order  to  simplify  the  notation  and  subsequent  explanations,  it  will  be  convenient  to 
treat  th*  a  prinrl  information  formally  as  tha  Initial  awasureawnt  a.  ,  at  ahown  below; 


where 


*Cx0l 


and 


*[<«. 


(3.4) 


Thua,  the  a  priori  information  about  the  initial  value  of  the  itete  x.  le  that  It  ie  a  random  variable  with 


mean  a.  and  oovarlanoe  R. 


The  state  xk  le  the  quantity  to  be  eatlnttsd,  The  best  eitlmete  of  the  state  ik  ,  given  the  measurements 
a,  for  J  *  0 M ,  la  denoted  by  Stk/N  ,  and  It  la  a. linear  ooablnation  of  the  mersuramente  with  coeffi¬ 
cients  given  by  the  nx  r  weighting  aatrix  \/j  i 


it 
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!k/N  = 


(2.S) 


Th«  estimation  prooedura  la  called  fllterlni  If  k  equals  N  ,  prediction  If  k  la  iroater  then  N  ,  and  smooth- 
ln«  If  k  la  leu  than  N  .  The  error  In  the  sstlmnta,  denoted  lk/fl  ,  la  the  difference  between  the  etato  and 
the  beat  aatiuata  of  the  atate: 

*k/a  a  »k  -*k/N  =  *k  ‘  \/]«j  •  8) 

The  partial  derivative  of  the  error  with  reapaot  to  the  coefficients  Ak ^  la  equal  to  the  measurement  Zj  , 

^*a/N^*k/j  ~  ~  *j  ■  fa.  7) 

The  beat  estimate  of  the  atate  will  bo  defined  aa  the  linear  afttluate  which  olnialr.ee  the  mean  square  error,  wltioh 
la  the  trace  of  the  covariance  of  the  error  Pk/H  : 

fk/N  =  K^k/N^k/H'  •  <a.8) 

Since  the  linear  coofflolente  Ak/j  are  choaen  to  minimize  the  mom:  euunre  error,  the  oondltlon  for  thle  to 
be  a  alnlaua  la  that  the  partial  derivative  with  reepeot  to  the  ooefficienta  le  aero, 

“  0  tor  J  s  C ,  1  ,  . . .  N  .  (9.0) 

lubstltutlna  the  eauallon  for  the  error  Into  tha  aovarianca  (ivaa  an  axpreaalon  for  tha  naan  aquara  arror  which 
la  quadratic  in  the  ocefflolente.  Cerrylni  out  the  differentiation  tivae  an  expreaaion  which  la  linear  in  the 
eoefflelente  -  the  eeapled  Wlener-llopf  equation  ..  which  la  aufficlant  to  ditarnina  the  coefficients, 

*  0  “  •*  91rtk/N»j)  for  1  ■>  0,1,...N.  (9.10) 

Tbit  expreaeiun  can  be  Interpreted  by  aaylni  the  error  In  the  bast  eatlnate,  xk/,N  ,  i«  unoorrelated  with  any  of 
tha  msuurmmants  which  sads  up  that  eatloaLa,  Since  the  but  eatiaate  la  a  linear  combination  of  the  measurements, 
tble  aaane  the  arror  In  tha  beet  estimate  la  unoorrelated  with  thh  cellmate  itaalf, 

E<Xk/HaiJ>  ■  0  for  J  ■  0,1,...  N 

■<Wk/K>  «  ••  »■»> 


I. I  Innovations  Approach 

The  inuovet ion  le  tUu  new  Information  whluh  cornea  from  each  Maaureaent.  Tha  Innovations  approach  to  linear 
eatlmatlon  la  bued  on  the  assumption  that  tha  actual  measurements  and  tha  innovation  process  (all  the  innovations) 
are  equal  In  the  senes  that  they  contain  the  same  Information  u  far  aa  linear  operations  ara  oonosrned.  Tho  new 
Information  la  the  difference  betwmen  the  aotual  measurement  >k  and  the  beat  eatlMta  of  the  measurement,  liven 
all  the  previous  msasursmenta.  Tha  best  eetlmate  of  tha  measurement  le  the  output  matrix  (L  times  the  beet 
aatlmate  of  the  state  3k/k.,  while  the  new  Information,  danotad  by  ^  ,  la  tha  error  in  this  eetlmate, 

®k  =  *k  -  *A/k*i  *  Wk-i  '•  vk 


alnae  \  a  l^a,,  +  vk  .  (9,19) 

The  beat  ostlmate  of  the  measurement  has  tbe  saw  properties  aa  the  beat  estimate  of  the  etete  discussed  previously, 
while  the  new  lnformstlon  has  the  sue  properties  aa  the  error,  Tbe  new  information  of  the  ktb  measurement  is 
unoorrelated  with  any  previous  meuurvmenta  and  the  new  information  la  unoorrelated  with  the  eetlmate.  These 
properties  of  the  new  information  can  ba  used  to  derive  a  sequintisl  eatlmatlon  prooedure. 

Assume  the  current  beet  estimate  can  be  calculated  te  tbe  aum  of  the  previous  beet  estimate  ik/H.t  and 

a  coefficient  time*  tbe  new  Information  iN  : 

*b/n.  *  *k/x-i  +  *k/N*it  •  <2.l»> 

If  the  coefficient  Bk/N  nan  be  ohosan  so  tbe  error  in  the  current  best  estimsts  Is  unoorrslstsd  with  eny  of  the 
measurements,  it  will  Indeed  be  the  best  istlmate  because  it  satisfies  the  sampled  klsner-Hopf  equation.  Tbe 
error  in  the  ourrent  beet  estimate  is  composed  of  two  terms,  the  error  in  tbe  previous  best  estimsts,  and  tbs 
error  In  ths  nsw  information: 

Vn  *  *k  “  ^k/n  *  Vh-i  ~  \/**k  •  <3,14) 

BscauM  thay  ara  errors  in  beat  emttmatea,  then  two  terns  are  unoorrelated  with  tbe  previous  measurements, 


((l^aj)  «  0  for  .1  a 


0,  1  ,  ...  N  -  l  , 


(3,15) 


■  1.09 

For  thi  ourrent  Boasursmont  tho  condition  that,  tho  error  bo  uneorrolatod  rtottrulnex  tho  oocffiolont  Bk/„  , 

0  b  S(Sk/N»k)  i  K(VN-t*i>  -  Bk/NBdH^)  ■  (J.  10' 

Th« r» for*,  the  aaquontlal  situation  procedure  In  (3.13)  lives  the  best  oetimats  as  Ion*  u  the  coefficient  Bkr,N 
sstliflii  Equation  (2.10).  For  prsotlosl  computation  t  more  convenient  form  for  the  coefflolsnt  Is  obtained  by 
using  the  following  relations: 

“li 5  e  R<*k/N-i*N>  =  e(*k*n' 

S(iHtj,)  «  E(2NSijJ)  .  (3.17) 

These  relations  allow  tho  ooefflclont  B^  to  bo  written  In  the  fora 

*k/N  r  ^k/N-i  + 

®k/N  *  S(*k8|J>  E(*nSn)“  •  (2.1fl) 

The  noise  vk  is  unoorrolated  with  tho  error  In  the  best  estimate  so  the  covariance  of  tho  now  information  \ 
can  bo  calculated  directly  using  (2.12), 

"<Vk>  *  "k»<Vk-l*k/k«.>«i 

+  l(vkvj)  ■  Hkpk/k-iHk  +  •Se  ■  (2.12) 

Multiplying  the  sequential  error  (2.14)  by  the  atate  xk  gives  a  sequential  prooedure  for  ouloulatlng  the  covari¬ 
ance  of  ths  error, 

i<*k/h*k^  'a  *<*k/«-i*k>  “  Bk/KB'*Nl'll> 

Pk/N  *  •Vn-i  “  Bk/KE(iN*i) 

"  pk/N-i  “  ak/N^*li®N'Bk/N 

■  inoe  ^k/jV  “  Pk/J  •  (2.20) 

TO  suaeariae,  the  acqueutial  farm  of  the  optlasis  estiaate  and  the  associated  covariance  equation  are  given  by 
(2. Id)  and  (2.20).  The  forot  of  the  solution  is  quit*  general  and  does  net  depend  on  the  eywtem  equations.  The 
weighting  coefficient  involves  two  covariance*.  One  of  these  is  given  in  (3,12)  with  t>M  ,  but  the 

other  covariance  is  as  yet  unknown.  When  N  a  k  -  1  the  above  equations  apply  to  filtering  and  prediction. 

Mien  N  >  k  the  equations  are  for  fixed  point  smoothing  because  they  show  the  ahsiig*  in  the  emoothed  estimate 
st  the  kth  point. 

1.3  Filtering  and  Fixed  Point  Smoothing 

Up  to  new  it  ha*  not  been  necessary  to  sxasins  in  detail  the  system  equations  for  ths  etsts  or  tho  Mssuremsnt. 
However,  to  oalaulst*  the  coefficient  ,  for  the  eequential  estimation  praaadura,  It  will  be  neaaatsry  to 
find  a  way  of  calculating  ths  oorroiponding  novarlanoia.  Consider  first  -h*  single-step  eetlmation  problem  In 
(2. IB),  wber*  k  1*  replaced  by  k  +  1  and  N  la  replaced  by  k  .  Thi*  le  the  femlllsr  Kalman  filter  equation, 
where  BfcM/k  i*  the  gain  matrix  for  the  filter, 

*ktt/k  *  ^kti/k-t  +  ®kvt/k*k 

V./k  *  •  <3.31) 

For  one-step  eetlmation  the  unknown  oovarlano*  and  the  gain  matrix  can  be  determined  directly. 

*<Vi*k>  *  «K*kti*k  +  uh><Vk/k-i  +  Yk>'] 

*  ®k*ipk/k-iHk 

It  ehauld  be  painted  out  her*  thet.  for  ths  epeclal  case  where  the  dyuasio  nolee  uk  and  tho  meaeurement  note* 
vk  are  correlated,  the  unknown  covenant*  hoe  an  additional  term: 

*<*kn*k>  ■  «kupk/k-:»k  +  *<Vk>  • 

To  oosplet*  the  aolutlcn  to  the  oue-atep  eetlmation  problem,  it  le  neooeeary  to  aeloulete  t  eequential  relation 
for  tb*  oovarleno*  of  the  error  PkH/k  whloh  la  uied  in  the  gain  aetrlx.  The  beat  prediction  must  be  the  boat 
eetimat*  time*  the  transition  matrix, 

*kti/k-i  *  *k»rVk-i  ' 
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Tha  error  In  tbe  bait  estimate  le 

^ks l/k  =  xkti  "  xk*i/k-l 

=  (t|l+lX|(+ U|,)  -  C +  \«i/k^k*k/k-i  +  vk'l 
=  ^kti^k/k-i  +  “k  “  ®k*i/kvk  • 

,h,r,  V-ke,  =  *ktl  -  Bkti/kHk  .  <2.23) 

Tha  eovarlanoe  of  the  arror  la  obtained  by  multiplying  the  error  by  the  state  and  taking  the  expoctod  value: 

pk+i/k  =  E^k*i/kxk*i^ 

=  EZku/k  ^k+i  :k  +  uk^ 

=  ^'kti'Wi'Vi  +  «k  • 

The  covariance  for  the  current  estimate  can  be  written  In  a  similar  way, 

pk/k  =  ^k+i^k*ipk/k-l  =  ^  -Bk/k*VIVk-i  ' 

where  Vk  =  ^'iiWk 

and  Pk+l/k  =  ViWki  +  0,,  .  (2.28) 

These  are  Kalman  filter  aquations  for  tha  one-step  estimation  problem.  To  extend  this  to  the  smoothing  problem, 
where  N  Is  greater  than  k  .  It  Is  necessary  to  see  how  tie  errors  In  the  estimate  evolve.  The  matrix  0ktl  in 
(3,23)  shows  how  tbe  estimation  errors  evolve  from  one  point  to  tha  next  point.  Applying  this  to  the  points  from 
k  to  N  one  a an  write 

*n/h-i  s  •  •  •  ^k+i*k/k-t  + 

+  terms  involving  Uj  and  Vj  for  k  <  j  <  N  -  1  .  (2.26) 

Since  xk  is  unoorrelated  with  the  Uj  and  Vj  ,  the  unknown  oovarlanoe  oan  be  written  as 
*<xk*^  =  t[»k(M*/»-i 4  vHJ'l 

*  *<*k/k-l*i/N-l)»H 

*  pk/k-i^N/kHiI  • 

•here  </V/g  -  ...  «/rkM 

and  n  .  (3.27) 

S.4  Other  Smoothing  Solutions 

Tbe  fixed  point  smoothing  solution  giveu  by  (2. IS),  (2.19)  and  (2.27)  will  now  bo  used  to  derive  other  recursive 


versions  of  the  smoothing  solution.  At  each  point  .-here  the  new  information  2j  la  reoeived,  It  la  multiplied  by 
the  weighting  aatrlx  B^/j  In  (2.18).  The  smoothed  estimates  at  points  k  and  k  t  1  oan  be  written  as  the 
weighted  sum  of  all  tha  new  information, 

*k/w  ~  Vk  4  “k/j*j 


^kii/s  a  xkn/k  J'  “k+i/j2!  • 

from  (3.27)  the  previously  unknown  oovarlancus  and  the  wolghting  ooefflolent  oan  oe  related  to  a  new  matrix  Ck  , 

*(*k*s)  =  pk/k-i'AUv'A</i*iH!l 
*  ckpke-k/k'^,H/k*aHM 

^  V<«htlS>  1 

whar.  ^  •  <*•»> 


m 
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IS 
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f.) 
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For  tho  weighting  coefficients  in  (2.28), 

^/j  *  ■ 

ainoe  Bk/J  =  E^apECSjlj)-1  .  (2.  30) 

Subtracting  Ck  tlmoa  tha  second  aquation  in  (2,28)  from  tho  first  aquation,  and  Baking  uae  of  (2,30)  to  canoal 
out  tha  taraa  lnvolvini  tha  no*  Information,  (Iran  a  relation  between  tho  mouthed  sctimate  at  points  k  and 
k  +  1  , 

*k/N  "  ^k/k  c  ®k^*k+i/N  ”xkti/k'  •  (2.31) 

This  aecond  voralon  la  called  nmoothing  with  filtarad  aetimateit.  The  anoothad  eaiicmte  at  k  ia  calculated 
from  tha  aooothed  eatioata  at  k  +  1  and  tha  filtered  eatlmne,  in  tha  aloe  way,  the  anoothad  covariance  (2.20) 
ean  be  written  a*  the  aun  of  taraa 


pe/n  =  pa/k  ~  Ba/iE(“j*i)Ba/j  for 


n  =  k  and 


1  . 


(2.32) 


Premultlplylng  tha  aquation  with  ■  =  ’  +  1  in  (2.31),  hy  Ck  and  pout-multiplying  by  Ck  ,  aubtraetlng  from 
the  equation  with  nek,  ami  Baking  uae  of  (2,30)  given  a  relation  between  the  covariance  of  the  eaoothad 
eatlMtae  at  pointa  k  and  k  +  1  . 


Pk/N  ’  pk/k  n  ck^pk*i/N“pk*l/k^Pk  • 

An  alternative  definition  of  tha  matrix  Ck  which  ia  uaeful  la  obtained  from  (2. 33), 
°k  *  *Wk*keipkei/k  .* 

elnoa  pk/k*kti  a  pk/k-i^*i  • 


(2.33) 


(2.3d) 


.  A  (lightly  different  form  of  smoothing  using  the  filtered  estimates  ia  obtainad  by  grouping  taraa  and  making 
use  of  somo  idem  it  lea ,  in  (2.24).  Uultiplylng  (2.31)  by  4kM  and  subtracting  xk/N  gives 

®k*i*k/k  “  *kei/N  s  ^k»l®i  ”  W^k+l/N  ”  ®k»l/k^ 

B  “  *lkpkii/k  ^k+l/N'®k*l/k^  ' 

•lnoa  Vi°k  e  V«pkA-W’ktipkii/k 

*  'pk+1/k-«k>pkil/k  •  (3'38> 

Tha  amoothlng  solution  with  measurement*,  the  third  vtralon.  la  written  in  a  similar  form,  but  It  requires 
soma  detailed  algebra,  making  use  of  complicated  identities,  to  show  tha  equivalence.  The  measurement  amoothlng 
Involves  e  new  vaotor  ay  which  le  oalouletsd  sequentially  and,  in  the  continuous  version  of  the  problem,  can 
be  interpreted  ea  e  hagrenge  aultipUer.  Tha  smoothing  solution  involving  aaaauremanta  is 


*ku^k/w  “  ^ku/w 


~  Vk 

"k-l  =  *kei"k+  ^"k‘<*k-Mk/w> 


with 


cm  *  0 


(2.38) 


Comparing  (2.38)  and  (2.38)  gives  a  dlraot  intarpratatlon  of  tbs  vaotor  ay  ,  but  no  blot  how  to  derive  the 
recursion  formula  for  ay  , 

‘'V  s  Piil/k(*k+l/n "  *k+i/k^  ■  (3-37) 

In  order  to  derive  the  recursion  formula  it  will  ha  neeasasry  to  make  uae  of  tho  two  relations 

pi)k  *  Pi)k-i  + 

p;)aVk  =  p'kV.Wi  +  Hk"i‘\'  (3-38) 

Tbaaa  rwUtlons  arias  naturally  whan  using  the  maximum  likelihood  derivation,  but  they  seam  artificial  hare. 

The  first  relation  oan  bs  proved  by  multiplying  Pk)k  by  Pk/k  in  (2.25)  to  gat  the  identity.  The  second 
relation  oan  bt  proved  by  showing  that 


*k/k  =  pk/'kHk*k1 


(2.3B; 


Starting  with  (2.37)  and  asking  use  of  tha  two  ralatlons  as  wall  as  (2.31)  gives  the  dtslred  recursive  relation 
for  ay  . 


O'  \\ • 

^>--Sv.V'vWj 

.■•V-  > 


s'. 


/"V"  V\*\| 


r/r  w  * 

V”.- , 


(2.40) 
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^k*it4lk  = 

”  Pk)kck^kti/N  —  ®k*  l/k^ 

r  Fi)k'5k/r*k/k> 

*  ^pk)k*i  +  Hk®kl*V*h/H  '  pit 1  xk/k-i  "  ,,kRi(l*U 

”  pit)k-i  <xk/N  “*k/k-i5  “  H£*j[l  (*k  "Mk/N* 

=  nig.,  -  <*ih-Khxk/M>  . 


The  fourth  and  lilt  veralon  Is  called  fixed  1>|  smoothing  bcoaueo  the  smoothed  estimate  la  always  a  flx«d 
Busbar  of  points,  s  ,  behind  the  latest  measurement ,  It  can  be  written  as  shown  bnlnw  where  the  vector 
can  be  defined  either  by  (2.37)  or  by  the  recursive  relation  in  (2.36):  ‘ 

*k/N  *  ^k*k-i/n-i  +  ®k/e*N  +  ®k-rt-i  ■ 

where  k  *  N  -  a  ,  (2.41) 

This  relation  Is  obtained  by  replacing  k  by  k  -  1  and  N  by  N  -  1  in  (2.36)  aud  subetltutlni  the  resulting 
eiDression  for  *k/N_t  into  the  fixed  point  solution  (2,18).  A  reourelve  relation  for  the  fixed  lag  oovarianoe 
is  obtained  by  replacing  k  by  k  -  1  and  N  by  N  -  1  in  (2,33)  and  substituting  the  resulting  expresalon 
for  Pg/g. |  into  the  fixed  point  oovarianoe  (2.20). 

Pk/N  s  **k/k-i  ”  Dk/M!E<aH®N)Bk/H  +  ck4 <pk-i/N-i -|,»i-i/la-i'<0)tl ^ f  *  <a>4a> 

Thus  far,  it  has  been  assuned  the  matrices  Qk  and  Rk  were  non-siognler.  If  the  matrix  Qg  is  singular 
it  will  not  change  the  form  of  the  solutions,  although  If  Qg  is  sere  the  smoothing  solutions  simplify  to 

*k/N  =  ^kiixkn/N  • 

If  the  matrix  Rk  la  singular  the  smoothing  solution  Involving  measurements  cannot  be  used  beoause  it  contains 
RjJ1  .  For  the  filtering  solution,  it  is  neoassary  that 

Vk/k-iHi  +  N 

be  noo-elngular,  so  there  may  be  a  problem  if  both  Qk  and  Rk  are  slngulsr. 


3.  CONTINUOUS  TIME  SMOOTHING 


3.1  Statement  of  the  Problem 

The  systea  to  be  estimated  is  described  by  a  sat  of  matrix  differential  equations 


dl/dt  a  FX  +  U  ,  0  <  t  <  T  .  (3.1) 

The  oontlnuoua  measurements  obtained  from  the  system  are  defined  by  the  equation 


where 


maHx+v,  0  <  t  <  T  , 
x  n  an  n  k  ]  column  vector  of  state  variables 

u  -j  u  ml  column  veotor  of  system  (input)  uncorrelated  dynamic  nolle 

••  s  an  r  x  1  ooluan  veotor  of  measurement  (output)  unoorrelated  noise 

S3  an  rx  1  ooluan  veotor  of  continuous  known  measurements 

P  =  the  nxn  dynamics  matrix  with  known  coefficients 
H  3  the  rx  n  output  satrlx  with  known  coefficients, 


(3.2) 


The  veotorm  u  and  v  represent  vector -valued  continuous  independent  random  variable*  (white  nolme)  rlth  ssro 
mean  and  known  covariance. 


E(u(t)u(s)')  s  QS(t-e) 

■(v(t)v(e)')  =  RS(t-») 

■(u(t)v(e)')  =  0  .  (3.3) 
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Th*  propsrty  of  the  dfltt  function  5(t)  li  thst  the  function  li  xsro  for  t  t  0  but  the  Integral  of  g(t) 
tints  th*  function  is  |(0)  If  the  integral  Includes  the  origin.  The  a  priori  infornation  is  that  the  initial 
value  of  the  state,  »0  ,  la  a  randon  variable  with  mean  x0  and  covariance  P„  , 

I(*0)  =  *<,  and  E[(x„ -*,)(*„ -S,)']  =  P„  ,  (3.4) 

Tho  onoothed  eetltnato  of  the  state  at  timo  t  ,  given  all  the  measurements  up  to  tine  T  ,  In  denoted  by  St/.T  , 
The  filtered  estimate  1b  denoted  by  xt/t  or  simply  x  .  The  covariances  of  tho  errors  in  the  smoothed  and 
filtered  estimates  are  P^T  and  Pt/t  =  P  respectively,  Tho  linear  estimate  Is  a  linear  combination  of  the 
a  priori  Information  end  an  integral  of  the  measurements 


*t/T  =  *t/o*o  +  fMt0  ^t/s^ 


The  best  estimate  la  tho  linear  estimate  which  minimizes  the  intesrel  of  tho  mean  square  error, 


Mlnlmlee  J1*’  Et(x -Xt/T)(x  - St/T>'3  dt  . 


3.3  Oantinuous  System  se  Limiting  Perm  of  Discrete  System 

The  discrete  lystem  can  be  considered  si  the  eaaplod  version  of  the  continuous  system  while  the  oontlnuoue 
system  own  be  considered  as  the  limiting  form  of  the  dlacrett.  Thtse  results  will  be  need  to  derive  the  con¬ 
tinuous  best,  estimate  as  the  limiting  case  of  the  discrete  bast  aitlmate,  Pirst,  oonnidsr  ths  continuous  systsm. 
Ths  linsar  differential  equation  oan  bo  integrated  from  time  t  to  time  s  to  get 

*(»)  a  4<*,t)x(t)  +  u*(a,t)  , 

where  u*(m,t)  =  f*  *  4(a.,<T)u(o)  dir  ,  (3.7) 

<tmt 

end  where  4(»,t)  lm  the  transition  matrix  whioh  aatiafias  ths  diffarantlil  aquations 
d4(e,t)/ds  =  F(e)4(»,t) 

*<t,t>  «I. 

Lst  a  a  t  +  €  ,  where  t  la  email,  and  there  is  an  obvious  analogy  between  the  oontlnuoue  system  and  the 
discrete  system, 

*kn  =  ^k+ixk  +  “k  • 

xk+l  s  x(t  +  0 
*k»t  3  *<*♦*•*> 

u^  =  u*(t  +  «,t)  (3.8) 

8inoe  the  oovarlanoe  of  the  continuous  dynamic  nolle  u(c)  is  a  delta  funotlon,  the  oovarlanos  of  tho  random 
input  uk  la  calculated  aa  follows: 

Ki^uJ)  =  Qk  a  J '"**  4(t  +  «,o-)Q(o-)4(t  +  *,cr>'  dcr  a  9(t)«  .  (3.9) 

Thus,  starting  with  a  continuous  systsm.  one  can  take  a  series  of  iiaplss  and  convsrt  it  to  a  disorsts  aystam. 
Th*  linsar  aquation  for  ths  msasursmants  oan  alio  ba  lntagratsd  from  tint  t  lo  tits  Ui  to  gat  an 
"avtrsgs"  valus  for  ths  nsamursntnt. -  Assust  for  ths  sossnt  that  H(t)  and  x(t)  art  constant  ovsr  that 
lntsrval. 

ft*4  M 

I(t)  s  <l/«)  J  I  ip)  do  a  H(t)x(t)  +  v*(t  +  «,t> 


( tt« 

v*(t  +  «,t)  =  (I/O  J  vfcr)  dcr 


Aotually,  ths  integral  of  ths  chants  In  H(t)  and  x(t)  will  bs  of  order  <  ,  but  that  can  bt  ntglsotsd  for 
small  (  .  The  analogy  bstwssn  ths  continuous  measurements  and  tbs  disorsts  sssaursments  is 

\  =  3(t) 

Vk  =  v*(t  +  «,t)  .  (3.11) 
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Tho  oovirlance  of  tin  noli*  ti 

*(vkVj;>  r  H,,  c  (1/a1)  J1*"  (tier)  dc  a:  R(t)/e  ,  (3.12) 

Nut,  oocalder  the  diicrett  eyaten.  Tho  limiting  form  of  tha  ayaten  difference  aquation  la  obtalnad  by  making 
a  Taylor  aarlaa  expanalon  of  tha  tranaltlon  matrix  for  email  t  and  neglecting  tarna  of  ordar  «'  danotad-  by 
0<«»)  . 

x(t  +  f)  =  [i  +  Fe  +  0(e')}  x(t>  +  u(t) 

1  In  [x(t+a)  *■  x(t)]/<  *  dx(t)/dt  .  (3.13) 

To  aunnarlM,  tho  Uniting  form  of  the  dlaorata  ayatem  la  obtained  for  amall  «  , 

lln  [xktl  -  xkl/e  =  dx/dt 

*k*i  -  1  +  F«  •' 

Qk  -  He 
\  -  lt/< 

\  -  H 
Xk  -  X 

ik  -  *  .  (3.  14) 

3,3  filtering  and  Smoothing  lolutiona 

Tha  nontinuoua  amoothlng  aolutiona  are  prelected  hare  aa  tha  Uniting  ouaa  of  tha  dlaorata  aolutlona  derived 
earlier.  Applying  the  Uniting  procaaa  to  the  filtering  aolution  in  (2,21)  and  (2.22)  and  tha  oovarianoa  in 
(2.24)  given  the  oontinuoue  filtering  aolution. 

dx/dt'  «  fl+  Blt 

dP/dt  s  PP  +  Pf '  -  BHP  +  Q 

with  r  a  -  Hi  and  B  *  PH'll'1  ,  (3.  IB) 

where  2  a  2t(/t  and  P  *  Pt/t  and  the  initial  oonditlona  are 

2,  «  J„  and  P,  =  P0  . 

The  number  of  terwa  in  the  oootlnuoua  oane  in  fewer  than  that  in  tha  dlaorata  oaae  baoauae 

^Vk/g-i*^  +  Rjj]  -  [HPH'  +  (R/a )]  "l  -  rl*  .  (3.  Id) 

Boeet lean  in  a  dlaorata  problan  it  Might  be  oonvaniant  to  integrate  tha  dlaorata  difference  aquatloua  for  tha 
oovarianoa  on  a  digital  oonputar  by  changing  than  to  the  oorreaponding  differential  equationa.  Aa  the  limiting 
procaaa  ahowa,  one  requirement  for  thla  approximation  to  ha  valid  la  that 

N  »  Hkpk/k.i«il  • 

Applying  the  limiting  prooaaa  to  the  fixed  point  anoothinf  aolution  in  (2.13),  (2.13)  and  (2.27)  and  tho 
oorreaponding  oovarianoa  in  (2. 20)  glvaa  tha  oontinuoue  fixed  point  aiootbing  aolution. 

dSt/T/dT  »  D(T,t)2t 

d»t/r/dT  =  -  D(T,t)BB(T,t)'  . 

where  D(T.t)  *  PJ)t0(T,t)H'R*1  and 

vl'fT.t)  >  the  Matrix  whloh  aatiaflsa  tha  differential  aquation 

d?(T,t)/dT  =  (P-BH)¥  (T.  t) 

¥(t,t)  3  I  ,  (3.11) 

Applying  the  limiting  procaaa  to  the  aaoothlng  aolution  involving  tha  filtered  eatinate  in  (2.31)  and  tha 

oor respond lng  GOYwitncis  la  (2.33)  givia  ths  ■noothini  lolutloa  for  ths  continuous  etas, 
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=  rW  w'lvrvt) 

dPt/t/dt  *  <r  +  «PM)Pl/t  +  Pt/T(PtOP-‘)'  -  Q  .  <3.18) 

Tha**  differential  equations  mint  bt  Integrated  backward*  from  T  to  0  and  ttio  beginning  condition*  at  t  =  T 
art  the  terminal  conditions  on  tho  filter  equation*  iT/T  and  Pt/T  .  The  Uniting  torn  of  the  matrix  Ck  ha* 
been  written  aa 

ck  -  i  -  t(r+ v1)  .  (3.18) 

Applying  the  Uniting  prnoere  to  the  filtering  solution  involving  tho  meaauremant*  in  (3.38)  glvea  the  amcijth* 
lag  aolutlon  for  th*  oontinuoua  oaie 

dxt/t/'dt  =  f*t/i  + 

doi/dt  =  ~  P'w  -  H'R"  •<* -Hfit/T)  .  (3.30) 

Qno*  again  th*  differential  equations  »ro  integrated  baokwardn  from  T  to  0  and  the  beginning  oondltiona  are 
the  terninal  condition*  on  the  filter  eolation*  iI(,T  and  eo(T)  =  0  . 

finally,  applying  the  Uniting  process  to  tho  fixed  lag  aolutlon  of  e  aeoonde  glvea 

d$t/T/dT  =  Pxt/T  +  D(T,t  )zT  ♦  (*u 

dPt/T/dI  a  (r  +  QP-‘)Pt/T  +  Pt/t(P+W1)'  -  4  -  Bfr.DWXT.t)'  , 
where  t  >  T  -  ■  ,  (3.31) 


4,  APPLICATION  -  STOCHASTIC  OSAO  MODEL 
4.1  Satellite  Treokins  with  Stoohaetio  Drag 

Thii  aafitlon  preaenta  an  example  of  aiaoothing  on  aatellite  traoking  there  a  stochastic  model  la  uaad  to 
Improve  accuracy.  The  praotioal  problem*  which  aria*  in  amoothing  ar*  aaiantislly  the  »ai*  an  thoaa  in  filter¬ 
ing.  A  modal  for  the  system  aquation*  muat  be  developed  aa  wall  aa  a  modal  for  th*  measurement*,  Valuaa  muet 
be  ahoaan  for  th*  mean  and  oovariano*  of.  th*  dyuamio  noil*  and  the  maaiuramant  noU*  and  for  th*  a  priori 
eatlmate  and  lta  oovariano*.  Tht  primary  differanot  batwaan  practical  problem*  in  filtering  and  thoaa  lk 
amoothing  la  lu  tha  affaot  of  inoludlng  dynamic  noiae  an  the  aodel.  If  there  ia  no  dynsoio  nolme  in  th*  modal 
th*  grata*  1*  deterministic  and  tho  smoothing  solution  i*  obtained  directly  from  tha  final  valu*  of  th*  filterad 
aolutlon.  Whan  thar*  la  dynamic  noiaa,  th*  amoothing  aolutlon  cannot  b*  obtained  so  euily  and  may  riquir* 
significant  additional  work.  Correlated  noise  on  tb*  msasuremant*  can  have  a  similar  affaot  to  dvnaalo  noiaa. 

To  handle  correlated  noise,  th*  state  equations  are  augmented  by  including  additional  state  varleblas  for  th* 
correlated  part  of  th*  nolee. 

Th*  problem  of  trajectory  estimation  involve!  reconstructing  th*  position  history  of  a  tiptoe  vahlol*  from 
a  aeries  of  aeaaureaanta  auoh  as  rani*,  anglaa,  or  Dopplar  velocity.  When  there  la  only  qravlty  acceleration, 
due  to  angina  thrust  or  air  drag,  the  motion  la  deterministic  and  can  be  completely  specified  by  six  parameters. 
Tha**  six  might  b*  th*  position  and  velocity  at  some  initial  tima,  or  a  eat  of  alx  orbit  alsmanta  at  tha  time 
of  th*  aaoendlng  nod*,  rrom  th*  six  parameters,  the  current  and  future  notion  can  be  determined  by  numerical 
Integration  of  th*  acceleration  due  to  tht  earth*  a  gravitational  field  or  from  a  oloaed-form  approximation  to 
tha  integrated  motion. 

In  general,  whan  drag  li  included,  th*  assumption  ia  usually  aod*  that  lta  affaot  can  alto  b*  represented 
as  a  datarmlalatlo  phenomenon  (for  Instance,  as  a  polynomial  with  undwtarmlned  coefficient*).  This  treatment 
may  be  adequate  aa  long  aa  drag  ia  not  a  significant  factor  in  th*  aatelllt*  motion,  However,  for  low  altitude 
eatlllltaa,  stoohaetio  fluotuation*  in  atmospheric  denelty  oaa  cauat  notioaable  changes  in  th*  aotion. 

The  particular  stochastic  nodal  presented  here  1*  baaed  on  th*  aaeuaption  that  th*  ntatistloal  properties 
of  tha  atmosphere  oen  be  adequately  represented  by  a  firit-ordor  stationary  Qauas-Markov  prooea*.  Therefor*, 
tha  aatalllt*  aotion  can  b*  determined  by  eisht  perimeter*  that  are  a  aat  of  aix  aean  orbit  alaemnta,  a  eaventh 
paraaatar  that  la  related  to  the  oonntant  average  value  of  the  drag,  and  ah  eighth  parameter  that  la  relatad  to 
th*  lMtentaneoue  deviation  of  tha  atoohaatlo  drag  froa  its  mean  valu*  A  aiailmr  model  could  be  developed 
whan  them  ia  aooalaratlon  due  to  angina  thrust.  Th*  stochastic  fluctuations  in  thrust  might  b*  due  to  ahenges 
in  th*  direct tea  of  thrust  or  tha  angina  performance. 

4.1  MUvUfiad  Modal  for  Analysis 

Th*  main  affaot  of  the  drag  acceleration  is  to  ohauge  the  ln-traok  motion  of  th*  satellite.  The  eatellit* 
arrive*  at  some  positioa  in  space  a  little  sooner  or  later,  depending  on  sbwther  the  drag  baa  bean  a  llttla 
larger  or  gaaller  than  expected.  Tb*  siapllfied  dleoret*  model  of  tb*  motion  sill  involve  four  stats  variable*  - 
th*  ln-track  angular  position  y,  ,  tb*  ln-traok  angular  valooity  y,  ,  tb*  naan  drag  acceleration  y,  ,  and  th* 
atoohaatlo  drag  acceleration  y,  . 


.‘e  e'v  V.  •" l  ■ 


178 


Tho  continuous  itochaetlc  acceleration  b(t)  la  assumed  to  bo  *  aero-mean  firnt-ordor  Harkov  pri'oosa  with 
exponential  gorralatlon  and  a  tin  oonatant  l/o  ,  Tho  dif forontlal  aquation  dosorlblnj  tha  itochaatlc  aooelera- 
tlon  haa  stationery  anro-moan  whita  noUo  u(t)  u  tha  exoltatlon, 

db(t)/dt  =  -  ab(t)  +  u(t) 

E[u(t)u(t+  a)]  *  q!(s)  .  (4,1) 

Tha  diaortto  varaloti  of  tha  atoohaatlo  aooalaratlon  la  xlvim  by  a  dtffaranoa  aquation, 

b(t  +  T)  =  b(t )  wap  (-oT>  +  u* 


u*  =  u*ft  +  T,t)  «  f**r+T  ajp  t-o(T-a)]  u(a)  da 

•«M  t 

K[u*u*]  =  ■  f*"T  axn  [-  2o(T  -  a)]  q  de 

■|»0 


r  qt  1  —  exp  (-2oT))/3o  .  (4,2) 

Tiia  diaorata  atoohaatlo  aooalaratlon  y,  ohaniaa  avary  T  aaoonda  whan  It  takax  on  the  value  o(  tho  cDntinuoua 
variable  b(t)  .  Tha  system  of  differential  aquations  for  the  aniular  lotion  are 

dyt/dt  a  i, 

dyj/dt  e  jj  +  y4 

dy,/dt  ■  0 

y„  a  b(liT)  for  kT  <  t  <  (k+m.  (4.3) 

Every  T  aaoonda  noisy  iseaiuraicenta  of  position  are  node.  The  difference  aquations  for  tha  dlanreta  system 

are 

•  *k+t  -  4ku*k  +  uk 


V  *  Vk  +  vk 

E(vk)  *  0  ,  E(V^V|J)  a  ltk 
»  (y^y, 

u£  ■  <0,0, 0,u*) 

"l  T  T*/3  T*/2 

0  1  T  T. 

h**  *  0  q  i  0 

00  0  asp  (-oT) 

Hj  a  <1.0, 0,0)  .  (4.4) 

Tha  oovarlanoa  of  tha  u  priori  lnforaatlon  In  diagonal: 

'p  0  0  o"l 

,  0  p  0  0 

•  o  ,  p  o  •  <4‘85 

_0  0  0  q_ 

For  tha  numerical  a samples  tha  sample  tine  T  mill  be  held  fixed  at  one  revolution  (T  =  1),  tha  correlation 
time  l/o  till  be  two  revolutions  (o  =  1/2)  and  the  aocuraoy  of  tha  Mssurements  will  be  eat  equal  to  unity. 
Three  oases  will  be  examined  The  sovorlanoe*  of  the  atoohaatlo  drai  q  and  the  a  priori  Information  p  for 

tha  three  oasis  are 
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In  gach  omo  35  maanursmontn  are  taken,  etarting  with  mt  .  The  dingaiml  element*  of  tho  oovarlano*  of  the 
estimate!  of  tho  otote  for  conn  1  oro  presented  In  Tnblu  !  for  both  flltorlng  end  smoothing,  Notluu  how  oinooth- 
ln(  decreases  the  error  lubstuiitlelly,  In  Figure  1  tho  variances  of  the  fllterod  end  smoothed  eiMmntei  for  tho 
angular  poeltion  y,  ere  plotted  for  both  case  1  end  omo  3.  In  both  iiif.ob  the  variance  up  pro  no  hen  e  etendy- 
etete  veluo  whore  the  information  lost  by  dynamic  nuleo  balances  tho  Information  gulned  from  edditlonel  measure¬ 
ment*,  Reducing  the  variance  of  tho  etoohuntlo  dreg  reduce*  the  etoudy-ntote  variance  of  tho  oetiiteten.'  In 
Figure  3,  tho  variance*  for  tho  angular  position  are  plotted  for  both  oust)  1  and  case  3.  Notice  how  the  'ultliil 
conditions  (tho  a  priori  Information)  have  e  eight  flcant  effect  on  the  first  few  oetleiatoa,  although  that  rapidly 
dies  out. 

4.3  Numerical  Result!  with  Real  (hits 

Tho  etochnatlo  drag  oodol  has  been  tested  by  uaino  date  taken  during  the  first  three  days  of  sito.Ultn  1000 
Onlcron1'.  The  satellite  wan  launched  on  November  13,  1060,  with  a  period  of  00.4  min,  and  wan  up  for  only 
47  days.  The  tpogeo  height,  perigee  height,  and  inclination  were  GM  statute  miles,  113  statute  miles,  and 
81. 0°,  respectively,  Over  the  first  three  days  the  average  constant  drag  was  24x10'*  frsotlonal  decay  of  the 
semi-major  axis  par  revolution,  which  corresponds  to  a  period  decay  of  nbout  0,2  sec/rvv.  This  satellite  wan 
chosei,  because  fluctuations  in  atmospheric  density  over  the  first  two  days  caused  a  drag  change  of  over  503 
from  the  first  day  to  tho  aeoond,  and  booauoo  there  wore  a  large  number  of  highly  accurate  ttakcr-Nunn  optical 
lightings  of  the  entolllto.  The  total  duta  consist  of  13  par.aeo  over  radar  stations  and  six  sets  of  optical 
sightings,  spaced  so  that  there  is  a  gap  of  about  S  hours  hotwesn  tho  first  and  atoond  day,  when  there  wore  no 
meaeuroaenta,  (There  was  tlao  a  aoventh  gat  of  optical  sightings,  which  wae  discarded  because  it  was  completely 
inooneiitant,  by  icaraa  of  nilaa,  with  all  the  reat  of  the  data.) 

Reeulte  were  obtained  using  both  eptioel  and  radar  data  but,  in  the  results  presented  hero,  the  radar  data 
were  used  to  determine  the  orbit,  whereas  the  optical  data  wars  uiad  an  a  check,  This  approach  wae  particularly 
appropriate  because  the  optical  data  war*  highly  accurst*  (perhaps  to  less  then  on«  hundred  feet)  and  also 
beaauea  the  radar  data  wart  concentrated  mainly  in  tha  northern  hemisphere,  whereas  tha  optloal  data  war*  mainly 
in  the  southern  hemisphere.  With  a  given  eet  of  date,  tha  quantities  that,  can  be  varlad  are  the  Initial  condi¬ 
tions  (tha  Initial  estimate  and  its  covariance),  the  r.m.s,  drag  of  tha  stochastic  modal  tr) ,  and  tha  correlation 
of  th*  atachaetlo  modal  (0a).  It  was  desired  to  •liminat*  tha  etfaot  of  tha  initial  conditions,  so  tlisy  wars 
choaan  with  a  rather  large  covariance  and  with  an  estimate  which  matched  the  data  from  thu  first  few  radar 
stations.  For  all  the  raeultm  prcaanted  hero  th*  initial  conditions  ware  held  flxtd,  while  only  the  r.m.g, 
drag  and  correlation  of  the  model  wore  ohongad. 

Since  tha  moat  Important  affect  of  drag  la  to  change  the  time  equation,  it  le  the  ln-traok  reel duals  that 
should  bi  examined.  Became  tha  radar  range  measurements  are  so  muoh  more  aocurate  than  the  angle  maaaursment*, 
tha  in-track  residuals  in  poaitl.cn  are  determined  hy  comparing  the  In-treok  position  et  the  time  when  tha  range 
reachea  a  minimum  (the  point  of  aloaest  approach),  The  weighted  r.m.e.  ln-traok  raald'iali  for  radar  data  alone 
are  plotted  in  Figure  3  as  a  function  of  r.m.a.  drag,  with  th*  correlation  held  fixad  at  two  revolutions  (about 
3  hr),  For  vary  low  r.m.s.  drag,  tha  atochaatla  modal  raduoes  to  tha  datarminlatic  model  and  tha  walghtad  r.m.a. 
raeidusla  approach  tha  value  obtained  ualng  the  determlniatlo  model  (3800  ft).  Notice  that  the  r.m.s.  raiiduili 
for  th*  otoahaatla  modal  reach  a  minimum  at  about  one-tanth  of  tha  value  obtained  using  tha  datarminlatic  model. 
For  very  high  r.m.a.  drag,  tha  forward  aatimatlon  procedure  tended  to  b*  marginally  stable.  The  high  value  of 
stochoatlo  drag  eu  used  to  overoorreot  the  estimate,  first  one  way  then  th*  other,  The  r.m.a.  ln-traok  rasidual* 
for  radar  data  along  art  plotted  again  In  Figure  4  u  a  function  of  the  correlation,  with  tha  r.m.s.  drag  hsld 
fixad  at  4x  10*’,  The  result*  uhow  that  the  r.m.a.  residuals  were  not  very  sensitive  to  tha  correlation.  Onoe 
again,  as  tb*  correlation  gats  very  large,  the  etoohaatto  model  will  ipproeoh  the  deterministic  model.  The 
astlmat*  of  the  stoohaatlc  drag  la  plotted  in  Flgura  5  os  t  function  of  revolution*  for  two  values  of  th*  correla¬ 
tion  with  tr  held  fixad  at  4x10*’.  Notice  how  the  larger  value  of  the  correlation  tends  to  mask  th*  rapid 
fluctuations  in  th*  drag. 

A  point -by- point  companion  of  the  ln-track  residuals  at  evh  radar  paea  in  presented  In  Table  II  for  the 
deterministic  model  with  r.m.e.  drag  zero  end  the  stochastic  a.  ml  with  tha  r.m.s,  dreg  4x  10"’  and  th*  correla¬ 
tion  10  rtv.  Comparing  the  two  sate  of  reeulte  shown  that  th«  ntochaitla  treatment  of  drag  has  reduced  the 
reildusle  from  the  determlniatlo  treatment  using  constant  drag  by  an  order  of  magnitude,  from  thousands  of  feet 
to  hundred*  of  feat.  In  order  to  check  the  radar  results,  th*  optical  date  were  included  with  zero  weight, 

1.*.,  the  residuals  of  the  optical  sightings  wera  calculated,  but  no  differential  corrections  war*  mads.  Th* 
rtsiduals  at  three  of  tbs  optloal  stations  were  leas  than  200  ft  and  at  th*  fourth  station,  following  tha  gap 
of  8  hr  with  no  measurement!,  the  residuals  war*  1500  ft.  Th*  prediction  of  th*  optical  aasaursmantu  after 
3  rev  and  0  ruv  following  the  end  ot  th*  radar  data  guv*  raoldualg  of  38,000  and  70,000  ft,  rsspaotlvaly, 
Indicating  that  there  still  might  be  earns  stochastic  fluctuations  on  the  third  day.  Also  a  capsule  iu 
separated  from  the  satellite  on  the  31  orbit,  end  thie  may  have  Influenced  the  drag  abarantorietloe. 
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TABU  I 


PI  Mona  1  Eleven  ti  of  the  Covariance 


Obiervntion 

Filterou  Ettinat*  (Rn/i,) 

Point  (k) 

oov(y1) 

oev(y,) 

oov(y,) 

covfy,) 

0 

1.00 

1,00 

1.00 

0.0100 

1 

0.63 

1.31 

0.02 

0.0100 

2 

0.60 

1.31 

0.84 

0.0100 

3 

0.82 

0.06 

0.20 

0.0100 

4 

0.79 

0,68 

0,13 

0,0100 

B 

0,75 

0,4« 

0.07 

0.0100 

10 

0.88 

0.18 

o.oon 

0,00095  . 

16 

0.60 

0,10 

0.004 

0,0009 

20 

0,40 

0.003 

0,0026 

0,0060 

2G 

0.47 

0.066 

0. 0020 

0.0000 

Obtiroatlo”, 

■Saoothnd  i* ((ante  (Pk/H) 

Point  (k) 

eovfy,) 

oov(y,> 

oov(y,) 

oov(y,) 

36 

0.47  . 

0.060 

0.0020 

0.0000 

34 

0.36 

0,066 

0.0030 

0.0006 

23 

0,18 

0,036 

0,0020 

0.0001 

32 

0.16 

0,033 

0.0020 

0.0066 

31 

0.16 

0.017 

0. 0020 

0.0080 

30 

•  0.18 

0.018 

0.0020 

0.0078 

16 

0.166 

0.014 

0.00.70 

0.0070 

10 

0.106 

0.O14 

0,0020 

0:0078 

6 

0.14 

0.016 

0.0020 

0.00 VS 

0.26 

0.063 

0.0030 

0.0060 

0 

0.46 

0.082 

0,0020 

0.0004 

TABLE  II 


Cm  par  la  we  of  In -Track  BaalduaU,  10*  ft 


Data* 

Devolution1’ 

Dittrnlnlitic° 

Stoduutic* 

1 

R 

0.4 

44.6 

2.7 

2 

0 

4.0 

ee  a 

0.1 

3 

R 

8.1 

8.7  . 

0.8 

4 

R 

6.1 

0.3 

-0.3 

8 

R 

7.1 

-1.6 

0.6 

6 

R 

8.1 

-3.0 

0.4 

7 

R 

11.4 

-4.4 

0.3 

8 

R 

13.4 

2.1 

0.4 

0 

0 

10.0 

»  a  a 

1.6 

10 

R 

10.1 

2.6 

0.7 

11 

0 

20.1 

a  a  a 

0.2 

12 

R 

30.1 

1.8 

0.4 

13 

0 

21.1 

•  a  a 

0.1 

14 

R 

31.1 

0.6 

-0.1 

16 

R 

32.1 

3.6 

2.1 

16 

R 

33.1 

0.6 

0.3 

17 

R 

28.4 

4.6 

0.1 

IS 

0 

31.1 

e  e  a 

28.0 

10 

0 

34.1 

... 

70.0 

"Optloal  »  0  end  radar  -  It.  °iudar  data  «lth  oonatant  drag  nodel. 

’’Since  tine  of  firat  aaaendlni  node.  d  Rader  data  <lth  acre  (eight  on  optical  (for  a  -  0.4x  10** 

50  *  10  rev). 
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John  B, Poller 


1.  INTRODUCTION 

The  so-called  "nonlinear  nmoothing"  problem  la  the  problem  of  estimating  the  state  of  aomo  noisy  pronoun  at 
some  lime  t  ,  given  noisy  moeeurumonte  related  to  the  prcicene  over  an  entire  measurement  Interval  all  lull  Includes 
the  time  t  ,  The  nonlinear  smoothing  problem  differs  from  the  linear  smoothing  problem  In  that  the  dlffereutUl 
equations  deHorlblng  the  process  and  the  observations  can  lie  nonlinear  an  well  an  llnoar.  A  typical  nonlinear 
maoothtng  problem  Is  the  post-flight  estimation  of  the  ftight  path  of  a  missile  based  on  tracking  system  measure¬ 
ments  made  during  the  entire  duration  of  the  flight,  If  the  estimate  of  the  missile's  position  and  velocity  at 
tha  midpoint  of  the  flight  li  doilred,  the  estimite  oan  be  besot)  cn  all  of  tha  measurements  mads.  Including  those 
made  after  the  midpoint  as  well  as  those  made  before,  This  Is  the  smoothing  problem,  If  either  the  differential 
aquations  dseuribing  tha  flight  of  the  missile  or  the  measurements  made  to  dutermina  tha  actual  flight  path  (or 
both)  ora  noniinaar,  the  problem  of  estimating  the  missile’  ■  position  and  valoeity  is  called  a  nonlinear  smoothing 
problem,  In  this  chapter,  methods  of  solving  tho  nonlinear  smoothing  problem  will  be  presented, 

Smoothing  problems  (or  any  estimation  problems  for  that  matter)  may  bo  olaaalfled  according  to  the  criterion 
by  which  Ihe  quality  of  the  estimate  la  to  be  Judged.  In  thii  chapter,  as  In  tho  raat  of  this  publication,  only 
probaballitln  criteria  will  bn  onniidiired,  For  tha  smoothing  problem,  this  is  a  marked  departure  from  practice; 
normally,  smoothing  is  performed  by  statistical  techniques  such  as  fitting  a  polynomial  to  a  set  of  observations 
in  a  laaat  squares  fashion  without  considering  tho  known  properties  of  the  nolro  In  the  measuremnnta  or  in  the 
plant. 

In  order  to  daaorlba  tha  clanalfloatlona,  some  daflnitiona  are  naoasiary,  Let  $(t)  be  a  vector  function 
of  time  repraianting  the  state  of  the  prooeae  or  plant,  Let  y(X, t)  be  another  vector  function  of  both  the 
■tata  2  and  time  t  ;  Jt  will  be  called  the  observation  prooaia.  Suppose  tha  prooeae  runs  from  time  t  =  0 
to  tha  time  t  *  T  , -and-that  tha  observation  y(X, t)  la  recorded  for  all  t  in  the  Interval  from  0  to  T  , 

The  smoothing  problem  Id  to  estimate  2(t)  for”*ome  t  In  the  interval  hy  operating  on  all  the  observations 
In  tha  Interval,  Denote  tho  eatlmata  by  8(t)  , 

If  J|(t)  la  aslaatad  so  that  tha  probability  $(t)  a  g(t)  la  maximized,  tho  eatlmata  £(t)  la  uallad  the 
maximum  likelihood  estimate  of  2(0  .  it  X(t)  le  selected  so  that  tha  oovarianoa  of  tha  asttmato 
i{[X(t)  -j(t)HX<t)  -  $(t)P>  (whara  E(.)  la  the  expectation  operator)  la  minimized,  the  eatlmata  la  called 
the  minimum  varlanae  estimate,  Minimum  variance  eatimataa  are  particularly  useful  in  missile  aoouraoy  analysis. 
For  a  linear  plant  with  additive  gsuaeian  white  noise  and  linear  observations  with  additive  gauaalan  white  noise, 
tha  atata  of  the  plant  X(t)  Is  a  random  process  with  a  gnusslan  distribution,  and  any  estimate  of  X(t) 
derived  by  a  linear  operation  on  the  abaarvatlona  will  also  be  a  gausalan  random  variable.  For  this  case,  both 
the  maximum  likelihood  extlmate  and  the  minimum  variance  eatlmata  ars  tqual  to  the  mean  of  a  particular  giuasisn 
distribution  derived  by  xuoh  a  linear  operation.  Consequently,  fur  any  kind  of  linear  estimation  theory,  It  la 
unnecessary  to  differentiate  between  the  maximum  likelihood  aatlmatx  and  tha  minimum  variance  estimate. 

For  a  nonlinear  plant  and  nonlinear  obeorvatlons.  the  probability  density  function  of  tha  aatimats  conditioned 
on  all  tha  abaarvatlona  la  net  generally  gauaalan,  In  this  coat,  tha  maximum  likelihood  eatlmata  (wtiloh  oan  ba 
shown  to' be  equal  to  that  value  of  g(t)  for  which  tha  subject  density  function  has  Its  maximum  value)  will 
dlttar  from  tha  minimum  variance  animate  (which  can  be  ahown  to  be  equal  to  tin  mean  value  or  first  moment  of 
tha  subject  danslt.y  function).  Thus,  tha  proetdura  uaad  to  solve  the  nonlinear  smoothing  problem  will  differ 
depending  upon  whloh  type  ol  estimite  Is  desired.  Primary  emphasis  In  thii  chapter  will  be  placed  on  tha  problem 
of  finding  the  minimum  vtrianaa  aatimats,  beaausa  this  estimate  in  mere  useful  In  fiolde  auoh  si  missile  accuracy 
analysis  and  other  probabilistic  applications  of  the  smoothing  results,  However,  a  particular  approach  for  use 
in  obtaining  maxlmin  likelihood  estimates  will  also  ba  diaouaaad. 

minimum  variance  emoothlng  theory  will  ba  covered  In  Stations  2  and  3  of  this  chapter,  In  Section  2,  “exact'1 
differential  aquations  fur  the  "imoothod  expectation"  of  an  arbitery 'function  of  tlis  state  are  derived,  In 
Beotian  3,  these  differential  equations  are  approximated  by  other  differential  equations  whloh  are  easily  solved 
on  a  computer  to  obtain  tha  minimum  variance  estimate.  Section  4  presenti  a  brief  dinousaion  of  maximum 
likelihood  noniinaar  smoothing. 


a,  EXACT  DIFFERENTIAL  EQUATION  FOR  THE  SMOOTHED  EXPECTATION 

In  Haotlon  3.1,  the  problem  la  formulated,  and  Initial  steps  are  taken  towards  deriving  the  djelred  exact 
differential  aquations,  In  particular,  a  dlfferontiel  form  la  derived  for  the  probability  danalty  function  of  . 
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tau 


the  itata  conditioned  on  til  tho  observation*.  In  aubfitfqunnt  subsections,  adjoint  theory  and  Various  expnnMionn 
are  employed  to  convert  thin  to  an  uact  difterentltl  oquatlon  for  thu  expectation  of  an  arbitrary  function  of 
the  state.  conditioned  on  all  tho  observations, 

1.  t  Problem  Statement  and  the  Smoothing  Deneity  function 

Let  the  syetcni  bu  represented  by  the  n-dltneimlonal  state  vector  j(t)  ,  and  let  the  observations  y ( x,  t)  bo 
represented  by  the  m-dlmcnslonal  vector  j.(t)  .  Lot  thone  vectors  satisfy  the  following  eqimtlons: 

x(t)  =  f(*.t)  +  r<t>  (2,  1) 
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I(t)  a  g(X,  t)  >  7|(t)  .  (2.2) 

•here  £( t)  and  j(t)  ore  formally  gausslan  »hlto  noise  processes.  Equations  (2.1)  and  (2.2)  are  considered 
to  be  foranltsiim  of  the  following  .’qustion*: 

dx(t)  r  f (x.  t)  dt  +  d£(t)  t  r  ,  (2.2) 

dz(t)  =  *(x,t)  dt  +  dT)(t)  r  r  ,  (2.4) 

■here  r  denotea  any  terms  for  »hlch  the  expectations  aatlafy 

B(r)  *  0(dt)  .  (2,5) 

E(r’)  ■  Q(dtJ>  ,  (2.8) 

•bare  0(.)/ot  .  0  aa  dt  -  0  .  The  function  f(j, t)  la  assumed  to  be  piecewise  continuous  In  t  and  to 
poaaaas  pl»ea»lae  continuous  first  derivatives  In  x  .  No  explicit  assumptions  concerning  g(x, t)  are  made 
herein.  Hoaever,  assumptions  ■!!!  be  made  concerning  the  process  £(t)  and  the  availability  of  a  flUorltig 
density  function,  the  realization  of  which  may  constrain  g(x,t>  to  have  certain  properties,  in  particular,  to 
be  piecewise  continuous  in  both  x  find  t  .  both  functions,  f(x,t)  and  g(x,t)  ,  may  be  nonlihear, 

The  Independent  variable  t  is  aseined  to  he  constrained  to  some  set,  closed  st  least  on  the  right,  denoted 

by  (t0.T>.  It  it  possible  for  t,  to  be  minus  infinity,  but  T  Is  finite  Let  Zt,it  denote  the  set  of 

random  variables  j(t)  for  t t  (  t  5  t2  : 

Zti,tj  •  (|(t)  )  t,  <  t  $  t,>  .  (2,7) 

for  notatlonsl  esse.  Zt(Ji ,  sill  simply  b«  denoted  by  Zr  .  Assume  that  the  conditici  il  distribution  of 
l<t)  .  riven  ZT  .  extets  and  Is  absolutely  continuous.  This  implies  that  the  conditional  density  of  j(t)  , 
given  ZT  .  exists.  This  density  is  denoted  by  p  (t)bjlZt)  .  where  u  la  an  n-dtmenslonal  argument.  Because 
of  the  extensive  use  of  this  particular  density,  it  is  denoted  by 

a(M.t)  ■  pI(t)[jdZT!  (2.8) 

and  la  referred  to  as  the  smoothing  deniity  function.  The  numerous  occurrences  of  the  density  function 
Uj.jjImIZj]  make  it  desirable  to  give  it  s  special  symbol  and  none.  It  will  thereforo  be  referred  to  as  the 
filtering  density  function  and  denoted  as 


Km.U  •  PI(t,UlZt)  • 


A*  the  Itrst  step  In  obtaining  a  differential  fora  for  the  smoothing  denalt>  function  s(M.t)  .  the  aaoo  thing 
(tensity  function  It  written  In  the  fora 

’jfnW  a  /.*  *  S  •  ^  •  <210> 

■hart  tha  Integration  la  over  all  n- components  of  v  (this  convention  will  he  used  throughout). 

At  this  poinc.  the  one  and  only  as  tuition  concerning  observation  process  Is  aide.  The  observation 
process  is  aasiaed  to  be  separable1.  Separability  laplies  tnst  bounds  taken  over  dense  sets  of  points  U> 

(t9,T)  art  the  saw  as  those  obtained  over  ttw  continuous  iaraveter  space,  and  that  Malts  -’hich  are  valid 
when  spproachtd  sequentially  art  still  volid  when  approached  continuously  and  vlce-verra.  There  is  no  effec¬ 
tive  lots  of  generality  to  atauae  that  scat  process  is  separable,  because  if  aoat  process  ?.( t)  is  not  .separable, 
then  thert  exists  a  process  z(t)  which  is  separable  aid  which  equals  z(t)  ^ith  probability  one: 

P<z(t)  -  |(t)>  =  1  .  (2.  11) 

Vith  the  separability  hypothesis,  the  process  r(t)  is  replaced  with  a  discrete  process  i(t)  which  Is  equal 
to  l(t)  tor  t  belonging  to  the  set  of  rationale  and  equal  to  any  constant  for  t  belonging  to  the  set  of 
irrationals.  Thus,  only  when  t  is  a  rational  nuaber  does  *<t)  convey  any  information  concerning  t(t) 


j.J  -c  x.:-.  i'  -j 


*J 


'  *.  (•'.  -V.  ■  I 

,'j 

• .  .  .  f .  •  i'.  ■  ■  ‘ 

I  _  -  ,  -  fc  ■*  ■  *  *  •«  » 

•  •  •  .«  V  V  V 

•• .'V- ■■Vv\vV 

k  ■  "  -'ml 

’’i  •  »  •* 


■?•=•. -.rsilaj 


187 


Because  tho  rationale  are  countable,  z(t)  can  be  replaced  with  ?.(i)  and,  momentarily  replacing  t  with  1  , 
Equation  (2.  10)  boeomoa 

Pi(l)t‘IZtl  '  /„  B|(l)^li(l  +  l)  1  t  •  ^liU.D^T1  iv-  (3il2> 

The  first  term  In  the  Integral  oan  be  written  an 

PjUllpitdtl)  =  v  ,  Z,)  a  P^D^ixfl +1)  =  p  .  2t  .  Zl+l  T]  .  (2,13) 

Beoauee  of  tho  gaunslan  white  noise  assumption,  Equations  (2.3)  and  (2.4)  represent  Markov  processes.  'Jslng 
tho  Markov  property  that  tho  pnst  and  future  are  Independent  whon  conditioned  on  the  present, 

PJ(U  U'xa +1)  =  v  .  Z,  .  Z1>1T1  =  PjdjtM'fd  *«  =  v.  Z,1  ■  (2.11) 

Substituting  Equations  (2.13)  and  (2.14)  In  (2.12), 

p|(l)tif,zr]  "  f.lps< l)t£‘l2(1  +  1)  *  v.  '  zl]p;(l*i)[i;IZT]  iv- 


By  Bayes'  rule  for  conditional  densities, 

,  ,  ..  „  _!  PKllfe'Sd**)  1  M  •  Z|k.<l)tjfIZi5 

|(1)r"  “  1  *Kl*i)W 

The  denominator  of  Equation  (2. 18)  oan  be  evaluated  by 

pi(l*i)^lzll  *  /_*  ps<l“>C-Sa)  3  «•  2i]p,(i)t»'Zt]dM. 

By  the  Merkov  property, 

»|(J*l)Ijfl*«>  *  if  '  Zi]  *  «,i(l*l)C‘;li<n  =  <i]  ■ 
tiling  Equation  (2.18).  Equatlona  (2,18)  and  (2.17)  can  be  rewrtttan,  reapeotlvoly: 

,  .  .  PiruotMlkd)  *-  mIp.mJmIZ.I 


and 


pjftan (irizi}  ■  /.*  >i«7ot-5(i)  3  e'Pjo)^*!1  ^  • 

Thus,  Equation  (2. IB)  becosee 

/_"  pI<W-li(1>  s  ^p«(l)[i?IZllpi(fi)[!:IZT1  iv 


p|(l> W 


Pldeilt1*!! 


(2.  18) 


(2.  IT) 


(2.18) 


(2. 1#) 


(2.20) 


(2.21) 


By  the  separability  hypothesis,  t  and  t  ♦  dt  can  be  substituted  for  1  and  It  1,  respectively.  Doing 
this  and  ualng  Equations  (2.8)  and  (2.9)  In  Equation  (2.21), 


•(M.t) 


Q(£.t) 


r*  pi(fdt)tpl;(t>  =  <j 
pKt.dt)k|ZJ 


s(p  ,  t  +  dt)  dp 


(2. 22) 


or 

/  pj(t*dt)^i?<t>  '  .  t  tdt)  dp 

e(M.t)  *  — — - •  f3-23' 

/*  P |(fdt)[t:li(t>  z  elq(e't>  ^ 


Not*  that  Equation  (2.23)  lap  Has  that  the  smoothing  densit  y  function  la  not  explicitly  dependent  on  tha 
observation  process  In  any  Banner.  Of  course,  the  filter  density  function  q(^t)  would  generally  be  expressed 
as  a  function  of  the  observation  vector  anti  its  statistics,  so  that  the  tiaoothlog  density  function  is  implicitly 
a  function  of  the  observation  procoss  through  the  filtur  density  function. 


2.3  Differential  Equation  fur  the  Smoothed  Expectation 

In  this  Motion,  preliminary  step*  are  taken  to  obtain  a  differential  oquatiun  for  tho  "smoothed  expectation'* 
of  in  arbitrary  function  of  the  stats.  First,  some  definitions  will  be  given.  The  smoothed  expectation  of  on 
arbitrary  function  of  the  statu,  h(j)  ,  is  defined  as: 

E,h[x(t)]  ■  J“  tU^s^.t)  tM  .  (2.24) 


For  l.t.r  use,  tho  conditional  filtered  extioctatlon  of  an  arbitrary  f unot  1  on  h(x)  In  defined  as 

K,h[x(t)]  -  J“  ■ 


Defining 


dE,h[j(t)]  »  E,hfe(t>)  -  E,h[iU-dt)] 
and  formally  dividing  by  dt  , 

dK.h[i(t)l  1  r  t 

-hr  -  3  ?t  LE*hts<M]  =  . 


(2.25) 


(2.  28) 


(2.  27) 


Th*  objective  of  this  section  Is  to  obtain  an  expiesslon  of  the  torn  on  tho  right  aids  of  Equation  (2,27). 

V 

ly  definition  (Equation  (2.24)), 

E,,htx(t-dt)1  s  J"  h(£)pJ(t.dt)[jil2Tl  dji  (2.28) 

Substituting  Equation  (2.22)  In  Equation  (2.28), 


E,h[x(t  -  dt)] 


.  r 

L 


tm 

didi(M) 

•m 


p.rti  Ct'la(t-dt)  *  m! 


(2.28) 


The  smoothing  density  function  In  Equation  (2.28)  Is  evaluated  at  time  t  ,  as  la  the  corresponding  danalty 
function  In  EahCx(t)I  .  This  faot  la  used  to  advantage  by  deriving  from  Equations  (2.27)  and  (2.29)  an  equation 
of  tha  form 


dE,h  [g(t)l 
dt 


I.^h  [*(«]}  . 


(2.30) 


where  K,  Is  an  operator  yet  to  be  deteralned.  The  simplest  and  quickest  aethod  of  achlevlog  this  Is  first  to 
not*  that  tha  E(  oparator  corresponds  to  a  scalar  product  and  then  to  use  the  theory  of  adjolnts.  Denote  the 
scalar  product  as 


K,b(x(t  -  dt)  ]  =  <h<Aj) ,  s(£  .  t-dt))  . 

If  Equation  (2.22)  la  written  In  the  fore 

•(£.  t-dt)  =  »,•(£, t)  . 


share  K,  la  tha  oparator  indicated  by  Equation  (2.22),  then  Equation  (2.31)  can  be  written  aa 
«th(x(t-dt)]  *  (Mjt)  . 

Denoting  the  idjotnt  nt  I,  by  K*  .  Equation  (3.33)  becomes 
■th(x(t-dt)l  *  (E^h()i),  s(^.t))  . 
where  gjh(,u)  1*  given  Lqr 


^((f> 


»I(t)  f^t(t-dt)  a  ylp^t-dtilF'Vqtl 


p.ct.’TO?' 


dt/ . 


Not*  that  tbt  arfuasnt  of  K^h  la  tha  arguntnt  aftar  applying  K*  to  h  . 


(2.31) 


(2. 32) 


(3.  33) 


(2.34) 


(2.  35) 
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Squat  Ion  (3,27)  nan  no*  bo  rewritten  at 


«,h[i(t)]  1  , 

1  [«(£•).  «<u,t)>  -  (K*h(tf),  a(ti,t))] 


and,  by  tho  linearity  of  scalar  product*, 

dE,h[j(t)]  _  l 
dt 


=  —  (h(M)  -  K’hfy).  aOu.t))  . 


(2,36) 


(2.37) 


Equation  (2,37)  la  the  basic  differential  equation  for  tho  results  Lo  follow,  It  la  neceeaary  to  evaluate  the 
operator  Kj  firat,  end  some  nocesaary  preliminary  steps  are  presented  in  flection  2,3. 

Z.3  Expansion  of  a  Particular  Density  Function 

Before  proceeding  with  the  evaluation  of  the  uperotor  K*  ,  it  is  desirable  to  find  a  different  expression 
for  the  density  function  pJ(t) fu!s(t  -dt)  =  ni  .  nils  Is  accomplished  In  this  section. 

Because  the  integration  in  Equation  (2.35)  ia  ovor  p  ,  this  equation  oan  bo  rewritten  as: 

K>-  "  Wifcj  Ch^pi<»teli(t-dt>  -  ^Pju-dt)  ^'Zt.dt3  ^  • 


(2. 38) 


Tha  term  Pt/t)  Cff'*(* -dt)  a  v)  la  evaluatad  by  aonaidaration  of  the  baaic  plant  equation  (Eqn.(2.3))  and  the 
properties  of  the  indeplndenrincrenent  process,  From  Equation  (2.3), 

d{(t  -  dt)  —  x(t)  -  x(t-dt)  -  f(x  ,  t -dt)  dt  +  r  . 


(2.30) 


Tha  Jacobian  of  thia  tranaformatlon  la  Unity,  so  that,  by  firat  applying  the  Markov  property  and  than 
Equation  (2. 39) , 

»«<»>  Cdf'fCt-dO  *  u)  -  P|(t)  Cm  1  *(t  -  dt)  a  P,  Zt.dt] 

1  pdf(t-dt>^  “  «(t -dt)  -  f(x  ,  t -dt)  dt  +  r]  . 

Let 

Etd^it)]  a  j 

E[d{(t)di'<t)l  s  Q(t)dt  +  O(dt)  . 

Than  the  oharaotarlatio  function  becomes 


4(a1S',1i(t>)  =  exp 

llth  tba  aid  of  tba  invaraa  fturier  tranaform, 


dt  ,  . 

—  oi'Q(t)(v  )  +  0(dt)  . 
3  1 


pdi<t)  ^  |  axp  j  -  ite'/i  -  ~  oj'Q( t)ai  J  dai  +  O(dt) 


Combining  Equations  (2.40)  end  (2,44), 


PI(t.[«ll(t-dt)  a  v]  =  - 

lit)  _  _  -  (2tr)® 


jjjg  J  eap  |  -  Iv'lp-v-Uv  ,  t  - 


i  dt  , 
dt)dt  +  rj  -  --  o)'9(t)<4i 


(2.40) 

(2.41) 

(2.42) 

(2.  43) 

(2.44) 


dtp  +  0(dt)  ,  (2.45) 


It  if  desirable  to  expand  Equation  (2.45)  In  a  power  sir  Its  at  this  point: 

pltt)  U!*(t-dt)  =  u]  a  J  tip  [-  lcu'(ja-p)]{l  ♦  Iw'Cflv  .  t-dt)  dt]) 


f  dt  ,  1 

j  1  -  —  w  Q(t)co  >  do  +  O(dt) 


(2.46) 


Tt)t  following  ld«ntitU«  involving  th»  Dine  d»lt«  function  tre  cully  verified: 


ISO 


8((i- p) 

1 

72T7)n 

1 

3;,J 

(2  m" 

3*5({r-V) 

1 

^uj3^k 

(2«)n 

(2,47) 


|  ® 

J  -  1<uj«*i>{-  ioi'(ji-v))  dec, 
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-  6Jj0^exp{-  lw'(^-P)}  do)  , 


(2.48) 


(2,49) 


By  the  properties  of  the  Dirac  delta  (unction, 

/“  f(n.y)  i  (x-r.)  ix  a  f(z,y)  . 

•  mOD 


(2.50) 


Because  of  the  wavs  Equations  (2.48)  and  (2.49)  were  obtained, 


r  SS(p-K)  3  f”  „ 

I  — ~ — —  f(u)  du  =  - —  /  5(u-i0f(i,)  d^ 
J-.  "Mj  ‘  _  ” 


(2.  SI) 


and 


P*  aJS(M-i() 

J.a 


a*  r" 

—  f(v)  dl'  S  - — —  I  8(u-t/)f(P)  dy 
dPjd^J..  -  " 


(2.52) 


With  the  aid  of  Equations  (2,47)  -  (2.49),  Equation  (2.40)  becomes 

BS^-i')  dt,A,JL,  3*8  (ii-v) 


p,,t,  [)ilx(t -dt)  a  y]  a  i(/i- 1/)  -  [f.(v,  t-dt)dt)  t  Q 

S(t)  .  .  .  -  -  fr{  J  *  3Mj  2  frt  ■ 


,  (t)  +  otdt>  , 

3 Mj3/^ 


(2.53) 


which  is  the  dealred  result  of  this  aeotlon. 


2.4  Coaptation  or  Saoothed  Expectation  Equation 

Tha  derivation  of  the  exact  differential  equation  for  the  saoothed  axpeotatlon  of  h(x)  cm  now  be  oompleted. 
By  ueini  Equation  (2,17),  Equation  (2.38)  become* 


Kth<e)  = 


J  pj(t) [M'x(t  —  dt)  a  v]t(v  ,  t-dt)h(v)  dv 


/  P,(t)l4l*(t-dt)  =  v)n(u  ,  t-dt>  iv 


(2. 54) 


Nor  oonvenienee,  the  numerator  and  denominator  of  Equation  (2,54)  *111  be  denotad  by  S  end  P  ,  reipectlvaly. 
With  the  aid  of  Equation  (2.53),  Q  can  be  written  at 


Q  a  J  dnfc(P)q(i'  ,  t-dt)  i(£-V)  -  jfc  [fj(P  ,  t -dt) 


dt] 


*  T  £  £  V‘>  '1  +  0(dt)  •  (S- ”> 

1  plfrf  J* 


No*  etreiihtforeard  spplioatlon  of  Equations  (2.50)  -  (2.52)  yield! 


4  *  ,  t-dt)  -  dt 


2  r-  [  h(ii>  «<£  •  t-dt)[f.(£.  t  -dt)]l  - 

j.i-dMjL  J 


\  [h(M)q(M.  t  -dt)Qlk(t)  ]  l  +  0<dt)  .  (2,  5«) 
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P  Is  simply  evaluated  by  letting  h<£)  =  1  in  Equetlon ’(2, 58), 
P  e  q(^  ,  t  -  dt)  -  dt  < 


[q(£  ,  t  -  dt)  fj  (jL»  ,  t  -dt)  ] 


0(<lt)  .  (2.57) 


Let  09  denote  the  culloction  o f  terma  111  brackets  {}  in  Equation  (2,50).  Let  0,  have  a  similar  meaning 
f or  P  ,  ss  liven  by  Equation  (2.57).  Then 


1 


e“«>  , - 40fdt) 

q(£  .  t  -  dt) 


(2. 38) 


Assuming  0P/q(£,  t  -  dt)  Is  bounded,  1/P  esn  bo  written  an 

1  1  /.  dt{), 


P  q(ji  ,  t-dt)  \  ,  t  -  dt) 


1  + 


1 —  +  0(dt)l  . 


(2. SB) 


Substituting  {}„  and  {},  is  given  inequations  (2.58)  and  (2,37),  respectively,  and  simplifying,  Equation  (2. 54) 
becomes  \ 


-  =  b(M)  +  dt 


£  [r<*.  t-dtil,  n  ♦ 

U  --  >  Jk 


+  ^  ^  +  1  w£-v  w?-»  Sh<£>  aq(fc  ,  t-dt> 

+  FfW  34  ^  n(tt  .  fc-dt>  Jk  s^k 


+  0( dt)  . 


(2.80) 


In  performing  the  simplifications  leading  to  Equation  (2.60),  no  use  was  mads  of  tho  fact  that  q  is  not  a 
function  of  y.  .  This  fact  will  become  important  later.  Sine* 


1 


q(u  ,  t-dt)  3q(u,t) 

e  q(/u,t)  -  -5^ ~  dt  +  0(dt) 

wt 


q<e 


x—  fi  +2s^«  dt.o(dt)' 

e,t)  l  at 


(2.81) 


end 


3f,(M.t) 

f,(M  ,  t-dt)  w  f,(M,t) - l£—  dt  +  O(dt)  , 

J  -  J  —  ot 


(2,82) 


it  Is  apparent  that  Equation  (2.60)  Is  still  valid  whoa  all  arguments  t-dt  are  replaced  by  t  ,  That  la, 
the  difference  between  the  two  espreeslons  is  ot  O(dt)  . 


By  definition. 


«?«£>  1  p- 


(2.83) 


Comparing  equations  (2.30)  and  (2.37),  it  it  obvious  that 


i 


M  m  Tt  a<)t- 


(2.84) 


Equation*  (2.63)  and  (2.64)  yiald 
a 


Bh(£.)  BQ  j^(t)  1  Bh(^)  Bq(^,t) 

3iit  Jk  1  "^7  + 


O(dt)  . 


(2.65) 


.v\,v.v.- -w.  ■■v-.'  tvv^tv 


Equation  (2.30), 


Stjgy.!  •  !„„n  . 

dt  •  ' 


(2,60) 


combined  with  Equation  (2.09)  is  the  desired  differential  equation  for  the  smoothed  expectation  of  an  arbitrary 
function  of  x  . 


If  the  substitution 

h(/i)  =  6(^-v> 

is  made  In  both  sides  of  Equation  (2,60),  the  result  Is 
ds(^,t)  rjj-*  3[f (/u.t)  ],  w^-  .  ,  3s<£t,t) 


J-l 


J-l 


3  -  fzifa  3^n  sjrftr.1  Jk  ■ 


3*s(n,t)  1 

— k —  +  — 


3s(^,.t)Sq(y,t) 
UK 


_ >  >  Q  (t)  ‘ 

3mj3m|,  r  q(M,t)  jrf  p-f  Jlt  3Mj3nk 

% 

3a(M,t)  MgX)  *(u,t)  3alk(t)  3q(ji,t) 

’  t;  ~  + 


s(jf.t)  w^-vi1’ 

q5(u^t) 


w  ^  ft  V*>  ^  ro,dt) 
q(^.t)  f~‘  £■;  J"  3#^ 


(2.67) 


(2.88) 


which  is  the  differential  equation  for  the  smoothing  density  function, 

It  la  possible  to  derive  a  differential  equation  for  the  smoothed  expectation  of  an  arbitrary  function  of 
the  state  in  terms  of  filtered  expectations.  Strlebel  outlined  a  derivation  of  suoh  an  equation  in  Referenoe  3, 
based  on  the  limit  of  a  disarsto  formulation.  Peller3  used  a  similar  method  based  on  the  formal  techniques  with 
differentials  uaed  herein.  The  equation  is  prssented  here  without  derivation  (see  Peller3): 


dE.htjft:]  f  re(j,t)  "I  1  f  m(j,t)} 

-4-  ■  HI  -Bfr>L^}  *owt>  * 


where  L,  li  the  backward  dlffualon  operator: 


<(£■*  3  1  3’h(v) 

-  X  f.<!f  .  t-dt)  —  h<p)  +  -  XX  «,v(t)  —=• 
W  J  2  frt  fil  >k 


(2.60) 


(2.70) 


It  the  eubetltutlon 

h(M)  *  5(ji-i;)  ,  (2.71) 

le  made  In  Equation  (2.88),  tha  raault  la  tbu  differential  equation  1'or  the  mouthing  density  function  am 
already  given  hy  Equstian  (2.68),  as  Is  to  be  expected. 

Equations  (2.68),  (2.68),  end  (2.88)  are  the  principsl  result*;  they  represent  tie  "exaot"  differential 
equations  tat1 if led  by  the  (soothing  expectation  and  smoothing  density  function.  The  boundin'  condition  for 
Equation  (2.68)  1*  simply 

•<{J,T)  X  q(y,T)  ,  (2.72) 

and  the  boundary  condition  for  Equations  (2.68)  and  (2.86)  la  given  by  the  obvious  relation 

B,(h[x(T)]>  «  Ef(h[j(T))>  .  (2.73) 

As  was  mentioned  earlier,  no  use  was  mods  of  the  fsot  that  a  Is  not  a  function  of  m  .  In  faot,  had  use 
been  node  of  this,  It  la  obvious  that  one  of  ths  terms  in  Equation  (2. 68)  would  havs  been  equal  to  zero. 

Because  the  results  remain  valid,  these  "exact"  equations  osn  ssstly  be  extended  to  cover  the  product  noiet  case. 
Piret,  for  conaiacntis,  Equation  (2.68)  Is  rewritten  to  show  explicitly  the  possible  dependence  of  a  on  the 

system  atste: 
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kthf(p  = 
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EffM.OIj 


2h(jj) 
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n(if.  t) 


aiifji)  3q(m,  t) 
3mj  3M|, 


(2.74) 


Now  suppose 


d£(t)  =  M(x,  t)dio(t)  , 


(2.75) 


•hero  «(t)  la  an  n-vector  Increment  In  an  Independent  increment,  procena  and  Mix,  i.'  is  an  n  »  n  matrix, 
further  auppoae  that 

E(d<o(t)dai'(t)]  =  0(t)dt  +  O(dt)  ,  (2.70) 


then,  by  lotting 

Q(x,t)  =  M(x,t.)0(t)M'(x,t)  ,  (2.77) 

) 

Equations  (2,66)  und  (2,74)  apply  directly,  and  the  product  noise  case  la  accommodated. 

2,9  Comments  on  the  Exact  Differential  Equations 

Equations  (2.65),  (2.66),  spd  (2.6S)  together  with  the  boundary  conditions  given  by  Equations  (2.72)  and 
(2.73)  ore  in  theory  suffialant  to  lalvo  any  smoothing  problem,  in  fact,  Equations  (2.68)  and  (2.72)  ars 
auffloisnt  In  themselves  for  this  tssk  sines  once  the  smoothing  dsnslty  lunation  is  found,  the  smoothed  expecta¬ 
tion  of  any  function  of  the  wyetom  state  can  ha  found  by  integrating  that  function  multiplied  by  tho  smoothing 
density  function  ovur  all  infinity  in  parameter  space. 

Although  theae  aquations  are  exact  in  tho  mein  square  aonso,  they  are  impossible  to  eolve  In  practice  and 
they  muit  be  replaoed  by  solvable  differential  equations  whose  solutions  ire  "approximately"  equal  to  the  eolu- 
tione  of  these  exact  aquations,  The  reasons  that  those  equations  ars  Impossible  to  solve  in  practice  ere  ss 
follows.  Equation  (2.68)  lor  the  smonthlng  density  function  Is  a  seoond-ordor  partial  differential  equation  in 
all  componenta  of  the  atste  vector  whoso  domain  is  all  infinity  for  this  problem.  The  computer  requirements 
that  result  from  .this  type  of  problem  far  exnsud  whet  is  considered  practical  by  today' a  standards  in  computer 
technology.  In  addition,  it  is  nsoossary  to  have  the  filtering  uenalty  funotlon,  q(M,t)  ,  available  In  analyti¬ 
cal  form  or  to  have  lta  first  and  aecond  derivatives  with  respect  to  all  state  vector  components  available  In 
any  form,  Thla  le  virtually  never  true  in  praatioe. 

Now  that  the  difficulties  in  solving  for  the  smoothing  density  function  ara  known,  a  brief  note  is  in  order 
on  the  difficulties  in  dlraotly  solving  the  equations  for  thi  smoothed  expsotstlon.  First,  nots  that  the 
filtering  dsnslty.  function  end  its  first  derivative  with  respect  to  all  atate  vector  oomponents  are  required, 
something  we  have  already  seen  to  be  almost  never  true.  Second,  not*  that  the  smoothing  operator  on  the  right 
side  of  Equation  (2.681  operates  on  eaoh  term  in  Equation  (2.65).  This  requires  the  evaluation  of  the  smoothed 
expectation  of  new  tarma.  If  theta  ara  computed  by  again  applying  Equation!  (2.6.7)  and  (2.60),  (till  more  new 
tarma  are  introduced.  In  faot,  if  the  procesa  is  oontlnusd,  a  countably  infinite  number  of  terms  must  be 
evaluated. 

Thus,  it  is  alssrly  impossible  to  solve  directly  for  the  smoothed  expsotstlon,  or  smoothing  density  funotlon, 
tnd  approximations  which  are  more  easily  solved  must  be  sought.  In  the  next  section,  s  particular  set  of 
approximations  art  developed  which  permit  the  determination  of  the  minimum  variance  estimate.  In  t  following 
station,  a  method  of  obtaining  a  maximum  likelihood  estimate  will  be  described.  This  aettiod  is  based  on  an 
entirely  different  prooedure  and  will  be  presented  without  derivation. 


3,  MINIMUM  VARIANCE  SMOOTHING  APPROXIMATIONS 

> 

For  linear  systems,  tli"  smoothing  density  funotlon  is  gauseien  and  la  therefora  completely  deeorlbed  by  the 
smoothed  mean  and  covariance.  The  out  of  a  nonlinear  aystea  la  complicated  by  the  faot  that  the  smoothing 
danalty  funotlon  ia  not  neoeaaully  gsussiin,  and,  consequently,  the  smoothed  omen  and  covariance  may  not  com¬ 
pletely  describe  It.  In  fact,  aa  mentioned  previously,  a  countably  infinite  number  of  parameters  are  necessary 
to  completely  describe  smoothed  parsmetars  in  the  general  csss. 

Because  of  this,  approximations  involving  a  finite  number  of  parameter*  or*  sought.  In  the  esse  of  nonlinear 
filtering  theory,  two  ganertl  approaches  ire  moat  evident.  One  approach  is  to  approximate  the  conditioned 
expectation  of  a  function  by  a  Taylor  series  truncated  after  the  quadratic  terns.  This  is  the  approach  used  by 
Buoy",  Bass,  No  rum,  end  Schwarts*,  and  Schwartz*.  It  ia  equivalent  to  assuming  certain  higher  order  moments  to 
ba  negUlibls.  The  second  approach  la  to  use  quasi -aoaents.  This  approach,  used  by  Fisher’,  allows  the  con¬ 
ditional  density  function  to  ba  expressed  in  terms  of  tho  conditional  aeon,  conditional  covariance,  and 
quasl-ioment  functioni.  Both  approaches  oin  be  used  for  tho  nonlinear  saoothlng  problem;  tin.  truncated  Taylur 
■arles  approach  will  be  presented  in  this  section.  The  qussl-moaent  technique  has  greater  generality,  but  results 


In  very  complex  expressions  *hon  applied  to  the  smoothing  problon,  Section  4.2  very  briefly  aummarlxoa  the  Idea 
of  quesl-momerite.  (See  Pallor1  for  a  more  extensive  discussion  of  the  quasi -moment  technique  In  nonlinear 
smoothing.) 


3.1  Nonlinear  Minimum  Variance  Smoothing 

For  minimum  variance  smoothing,  tha  ooudltional  mean  of  tho  atato  is  tho  desired  estimate;  thus,  In  Equations 
(2.64)  and  (2.66), 

hjj(t)]  =  x,(t)  ,  1  =  1 . n,  (3.1) 


where  the  double  overllno  indicates  the  minimum  varlnnoe  smoothed  estimate.  From  tills  point  on,  It  Is  assumed 
that  Q  Is  Independent  of  ti  »  tato.  Using  this  assumption  end  substituting  Equations  (3.1),  (2.1)  Slid 
(2.64)  into  Equation  (2.66), 


1  3q(i,  t) 

q(«,  i")  3xk 


Equation  (3.3)  in  sxaut  In  the  mean- square  sense  (and  to  within  0(dt) ) .  Approximations  are  now  desired  for 
saob  term  on  the  right  of  Equation  (3.3). 


'  To  approximate  fj(j,t)  ,  expand  fj(j,  t)  in  a  Taylor  series  about  1  end  drop  terms  of  greeter  than  second 
order; 


f^D  »  ft(»  t 


■xJ->3f,(X)  -  1  Vf,(i) 

"air  (*J  ^ 


3MI)  m  3ft(a> 

^  i*i 

yft(I)  „  a^tdi) 
V\  3*j3xk  j-i  ‘ 

Applying  the  emonthlng  operator  to  both  sides  of  Equation  (3.4), 


*!<*>  -  f.<D  ♦  r 


( ^ i  —  L) 


Noting  the  Jkth  slsment  of  the  Moothlng  covariance  matrix  S  is  given  by 


Bjk  w  <*j-Xj)<xk-«k)  . 


Equation  (3.7)  beoomes 


ttii>  i  *i<l>  +  j 


afrr6l  J‘  3lj3*a 


An  approxlnatlon  for  [l/q(j,  t)  ]  [3q(j,  t)/3xkl  ie  now  sought.  If  q(j,t)  were  ectuelly  known  In  the  form 
of  cone  tnalytio  expression,  euoh  as  risher'a  quail-aoment^ expansion',  the  deilrsd  approximation  could  eaally 
be  attained  tp  techniqusa  like  thoee  uted  to  evaluate  f|(j)  .  \n  practice,  q(|,t)  la  unlikely  to  be  avail¬ 
able  In  nalytio  fora.  For  our  purpoaee,  It  will  be  assumed  that  the  filtered  mean  and  covariance  have  been 
obtained  (or  approxlautid)  by  same  technique  euoh  ee  that  or  Schwartz*.  To  obtain  an  approximation  for 
[l/«(I.t)j [3q(g, t)/3xk]  ,  it  will  be  aasuned  that  q(j. t)  ie  nearly  gausslan,  so  that  it  la  adequately  epproxi- 
■ated  by  a  gauaalan  density  function  having  the  'computed  iiltered  mean  and  covariance.  Denoting  the  filtered 
■ear  and  oovaiianoa  by  i  and  P  .  respectively, 


q(,,t)  4  (iwi^upTT*7'*  *vi~  1  [>-  >llt>'‘[t~tl)  ■ 


By  straight- forwnrd  evaluation  (recalling  that  P' 1  la 


whore  the  time  dependence  ham  beon  suppressed, 
symmetric), 


3q(i,  t)  .  JL,  , 

--s—  *  d(i,t)  jfi  (P'1)  • 


Consequently, 


1  3q(g,t) 


<1(1,0  3xk 

Applying  the  smoothing  operator  to  Equation  (3, 12) 


1  £ 


I  *1 


a,)  . 


_ L,  3q(-< i  y;  [p-1,,,1  ,s 

Qd.O  9lk  ■  i.i  1  !Ulkl(Sl  *!' 


With  the  aid  of  Equations  (3,3),  (3.8),  and  (3,13),  tho  differential  equation  for  i{  bocomeB: 

«111(t>[p-l(t)]|l|(*i  -I,)  . 


dt 


dx,  (t)  .  1  ST"1  a!f,(j) 

1 


A  dlffsrentlal  equation  for  the  oovnrlanoe  la  now  daaired,  since  it  appears  In  Equation  (3,14),  ay 
linearity  of  the  smoothing  operator, 


"  (Sj w Aj) ( Sg  "  2g)  -  XjXg  “  Sj^g  • 

Since  Equation  (3. IS)  Implies 

AJk  ‘  ^  Vk  -  -dj  <x"j  V  • 

it  suffices  to  evaluate  d(“)/dt  and  d(Xjik)/dt  .  By  letting 

h(»)  =  Xj*k 


In  Equations  (2.S4)  and  (2.69) 

drir 


^  3  Vk +  Vj  -  «jk  -  jfc  <«ji*k +  fc  ^‘WW  • 


By  the  linearity  of  the  smoothing  opirator, 

^  =  v: +  -  “ik +  £  fc  .<vT-  »a>  + 

+  Im  Pi  akl(P"’)la(xJ*a  '  ^jV  1 

For  aechanlaatlon  of  Equation  (3.18),  it  ie  auffioient  to  obtain  a  asohuiUtble  approximation  to  f 
all  J  and  k  ,  assuming  that  Equation  (3, 18)  la  mtnhanlzed  for  all  J  and  k  .  It  has  already  been' 
that  the  third  central  moment  la  negligible,  Since 


®kC(kj“^j)(ak”ig)(X|“i|)]  -  Ek[(jj-Xj)(Xg~2g)X|]  -  I^fXj-IjMXg-lg)*,]  , 

thle  ea sumption  lmpllss  that 

I§f(*j -*j)(xk  -ik)Xj]  «  8jk*j  . 


Multiplying  Equation  (3,4)  by  ik  , 


(ij  -«,)xk 


+  1  ^  a!£il5 
+  ?frr^T  "Sxi3s 


(I,  -X|)(xk-IB)xk  , 
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(3.  11) 

(3. 12) 

(3. 13) 

(3.  11) 

the 

(3.19) 

(3,  10) 

(3. 17) 

(3.  18) 

(3.  19) 

i*k  for 

aaauoed 

(3,30) 

(3,21) 


=  7j(|)xk 


(3.22) 


4  l  “it* 


an  raw 


3.  2  I, Inear  Minimum  Variance  Smoothing 


It  1(  interesting  to  determine  tho  results  of  applying  Equations  (3.14)  Mid  (3,2ft)  to  tho  unse  of  a  ltnesr 
ayetem.  For  a  linear  ayatem,  Equation  (2.  1)  becomes 

i(t)  =  F(t)x(t)  ♦  £{t)  .  (3, 28) 


wham  F(t)  in  an  n  *  n  matrix.  Thun 

f|dt)  =  jfcPySj 

and 

.  o . 

3xj3,k 


(3.30) 


(3.31) 


Substituting  Equations  (3.29)  and  (3.30)  Into  Equation  (3.14)  yields 


-L 

dt 


#.  '«‘i 


«lk(t>[p‘‘(t)]kl<*,-*,) , 


or,  aquivalently, 


Si 

dt 


rfft)  +  Q(t)f‘(t)[|(t)  -  Kt)] 


Prootadiug  similarly  for  fljk  , 


*i|(««U  ‘ 


(3.32) 


(3,33) 


(3.34) 


which,  whan  substituted  Into  Equation  (3.28),  becomes 


dEJk(t) 
■"  dt 


jfc  (rj ,Blk  +  rk,s,j)  -  «Jk  +  jj:  £  Qji(P‘lJ|Ab  +  jfc  £  Qmtp'lli.s.j 


or,  equivalently. 

■  [F(t)  +  Q(t)P‘‘(t)]S(t)  +S(t)[F(t)  *  8(t)P’l(t)]  -  Q(t) 


(3,35) 


(3. 38) 


Equatlona  (3,33)  and  (3.36)  art  Identical  to  linear  amoothlng  reaulta  obtained  by  Rauch,  Tung,  and  Btrltbel1 
and  repeated  elsewhere  in  this  publication,  because  the  smoothing  density  function  Is  gsusslsn,  tbs  minimum 
varianos  and  maximum  likelihood  estluatss  art  Identical  and  are  provldtd  by  tha  solution  to  Equation  (3.33). 
Boundary  oondltlonn  for  Equatlona  (3.33)  and  (3.30!  art 

|(T)  »  I(T>  (3,37) 

and 

8(T)  »  P(T)  .  (3.38) 

•here  T  la  tha  final  time  in  tha  amoothlng  interval. 


Tha  fast  that  Equatlona' (3.  14)  and  (3.2J)  rtduct  to  forma  identical  with  pravloualy  dtrlved  raaulta  for 
linear  ayateas  la  axpooted,  Each  approximation  Introduced  in  the  derivation*  of  the  equatlona  In  thia  aaotlon 
It  not  mn  approximation  at  all  when  applied  to  linear  ayatema.  Tha  fllter_density,  q(y,t)  ,  la  gauaalan  In  . 
this  oamt,  and  tha  third  central  aomenta  ara  zaro.  Tha  expansions  about  |  art  also  axaot  in  this  cast. 


3.3  An  Marat iva  Approach 

Tha  approiiaahe  nonlinear  mlnlaun  variance  amoothar  haa  tha  advantage  of  relative  alspllcM.y,  tut  la  baaed 
on  oartsln  questionable  asaiaaptiona,  Aiaualng  tha  third  central  moment  to  be  nsgllilblt  Is  squlvalsnt  to  assum¬ 
ing  thsrs  If  no  skawnsss  to  tbs  density  of  |(t)  conditioned  on  mil  the  dsta.  However,  all  aorta  of  simple 
nonllnearltles  produce  donaltiee  with  significant  ekewneea  when  driven  by  forcing  functions  containing  geuanian 
aolae.  It  la.  of  course,  qultu  possible  to  ues  higher  order  spproxieistlnns,  whether  the  improved  performance 
would  Juatify  the  Increnssd  complexity  la  questionable.  Including  a  moeiant  of  ordar  m  as  the  hlghost  moment 
In  the  approximation  alwaya  raqulres  tha  aeaumptlon  that  the  moment  of  order  m  t  1  la  negllgibla.  Because  oven 
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order  moments  (at  least  for  near  gauftilan  caeca)  are  not  at  alt  negligible,  It  In  dear  that  m  <  l  should  not 
bo  an  oven  nurabor.  Consequently,  to  include  the  effeotn  of  akownoes,  both  third  and  fourth  ordor  mnmontn  should 
be  inoludod,  It  appear*  that  eucli  a  procedure  may  soon  destroy  the  aimpllolty  of  the  approaoh. 

If  one  Is  truly  cniicornad  about  the  effect  of  sseuming  the  third  central  moment  to  be  negligible,  the  following 
iterative  approach  li  suggested.  Inequations  (3,  Ml  and  (3.  SB),  the  term  Bf.fjjh/Bx,  *aa  ueod  as  t  shorthand 
for  orjOO/aXj  evaluated  at  a  =  I  ,  and  similarly  for  3'f ,fx)/(3x^x,)  .  Jtf  thoso  terms  are  evaluated  for 
I  “  lc  i  whore  a0  is  the  o11'  estimate  of  a  .  tnen  the  following  iterative  equations  ere  suggested  to  use 
In  plsoe  of  Equations  (3.14)  and  (3.29): 


*{“  * 


+  {Ht  sjk 

)■  i  k«  i  uxJ°xk  k-l  l-i 


(3.  3D) 


bC»  1 

SJk 


I-l 


tBe. 


a*, 


+  ZZ  {t»ji [f>'  + 

1-1  m*  1 


(3.40) 


This  type  of  iteration  le  similar  to  quasl-linearlgntlon,  and  whersas  no  speoifio  itudies  have  boon  performed, 
it  Is  antioipsted  that  s°  i  and  s°  -  S  very  rapidly,  probably  to  high  accuracy  with  only  a  couple  of 

iterations.  It  should  be  noted  thst  Equations  (3.14)  and  (3.28)  should  provide  hotter  estimates  for  nonlinear 
systems  than  linear  theory,  end  the  use  of  the  iterative  technique  should  permit  quick  convergence  to  very 
aoourate  estimates  -  even  mors  soourate  than  Equations  (3,14)  and  (3,39)  used  In  noh- iterative  fashion. 


4.  MAXIMUM  LIKE!, I  HOOD  SM00THIN0 

,1  v. 

For  nonl)near  systems,  the  smoothing  density  function  will  not,  in  general,  be  gsuselsn,  thug  the  mean  value 
(minimum  variance  estimate)  will  not,  in  general,  be  equal  to  the  vsluv  for  which  the  smoothing  density  function 
baa  its  maximum  valua,  In  nome  oaaea,  one  is  more  Interested  in  the  maximum  likelihood  estimate.  There  are 
two  epproaohes  to  thla  problem.  One  approaoh  la  to  evaluate  the  maximum  likelihood  estimate  directly,  and  a 
technique  for  thla  is  presented  in  Section  4,1,  The  leoaud  approach  is  flrat  to  find  the  smoothing  density 
function  and  then  to  find  that  value  of  the  state  for  which  the  smoothing  density  funotlon  has  its  maximum 
value  (for  eaoh  t  in  the  smoothing  Interval).  A  possible  teohnique  of  doing  this  and  tha  reaultant  difficulties 
will  be  hrlafly  dlecusied  in  Section  4.3, 

4. 1  Direct  Approaoh 

This  direct  approaoh  is  due  to  Bryson  and  Prosier V  Let  the  eyetsm  be  given  hy  the  nonlineer  vsotor  equation, 


»(t)  *  J(J.B.t)  .  <<•» 

ehtre  x(t)  le  the  n-dluenslonal  state  vsotor  and  j(t)  is  a  control  vsotor  independent  of  the  Itate.  Assume 
the  a  priori  estimates  ere  available: 

E[j(t„)]  «  I,  (4.3) 

-  *„]  Ci<t0)  -  i.i'  >  3  p,  <«■»> 

«[fl(t)]  -  3(t)  (4.4) 

cUs<t)  -  i<t)][c(T)  -  a(T)]'>  *  6{t)5(t-r)  ,  (4,8) 

Let  the  relationship  between  the  lyitem  state  j.(t)  end  the  measurement  prooeee  be  given  by 

&(*<t)  ,  i(t)  ,  t]  «  0  (4,  #) 

for  the  oeee  of  no  neaiureaent  noise  (h  la  e  p-dlmeneloo  vector).  Let 

*([|(t)  -  i(t)]  [|(r)  -  jj{r)]'  }  *  K(t)S(t  -  t)  (4.7) 


be  in  a  priori  eettmeti  of  errore  In  j(t)  .  The  Dirac  delta  funotlcn  appiarirlg  in  these  equations  indioatee 
"white  nolle"  in  the  plant,  control,  and  aeaaurementa, 

Bryson  and  frailer  find  the  aaximua  likelihood  estlmste  of  g(t)  and  the  initial  oondltlon,  j(t0)  .  They 
also  state  that  the  miiieum  likelihood  eetieete  j(t)  of  the  etete  j(t)  le  nbtelneble  from  the  maximum 
likelihood  eatlaate  g(t)  of  the  control  g(t)  by  the  equetion 


i  »  Ki.fi. «  . 


(4,*) 
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ft)f  linear  syitems,  thin  is  clearly  true.  However,  for  nonlinear  syntema,  It  In  not  known  to  bo  trun  In 
lonsral,  and,  In  fnot,  tho  maximum  of  ona  probability  dcnatty  done  not  necessarily  amp  Into  tlni  maximum  of 
another  probability  density  function  u Imply  because  of  eoitie  functional  rolntionnhip  botwoon  tho  two  variable*. 
Therefore,  the  technique  will  bo  prnseutod  hero  with  tho  undemanding  that,  tho  result  of  the  computation*  will 
bo  the  maximum  likelihood  estimate  of  tho  control,  and  that  ;(t)  1*  elmply  that  estimate  of  the  state  which 
la  continent  with  the  maximum  likelihood  estimate  cf  the  control,  l.o. ,  that  which  satisfies  Situation  (4,8), 

The  maximum  likelihood  sstlnmtu  of  j(t0)  and  s(t)  is  found  by  minlnliilng  tho  functional, 

J  -  +  ~  J*  +  fl'Q"5)i)t  .  (4.9) 

where 

n  =  n  -  n  (4.10 


with  the  constraints 


h(£,i.t)  v  c 


and 


i  n  f(S,o,t)  . 


(4.  11) 

(4,13) 


By  tdjolnln*  the  constraint*  of  Equations  (4.11)  snd  (4.12)  end  applying  the  daloulu*  of  variations,  Bryson 
end  Premier  show  that  the  smoothed  values  of  the  control  aid  Initial  condition  satisfy 


fl(t)  a  fi(t)  +  5<t)  b(t> 


there 


end  the  boundary  conditions. 


kit) 


4<t) 


AiY 

w 


r'd-j) . 


.q<t)  =  u(t)  +  qf~j  Yb) 
ii(c.S.t)  --  a , 


*(t0)  »  i<t0)  ♦  p„6<t0) 

!i(T)  »  a . 


(4.  IS) 

(4.14) 

(4. 1»> 
(4.18) 

(4,  IV 
(4.18) 


By  this  epprueoh,  the  smoothing  problem  (for  maximum  likelihood  estimates)  becomes  t  two-point  boundary 
value  problem.  The  numerical  solution  uf  two-point  boundary  value  problems  on  digital  onaiputsre  Is  often  veiy 
difficult,  although  good  reaulti  tre  often  attained  hy  quiet -line  or  lest ion  techniques,  Assuming  such  teohnlquta 
tuocetd  In  solving  the  numerical  version  of  this  two-point  boundary  value  problem,  then  this  approach  has  the 
advantage  of  not  requiring  a  eolutlon  to  the  filtering  problem  before  the  smoothing  problem  can  be  worked. 


4,1  *iie 1- Moment  Approach 

As  mentioned  previously,  another  approach  to  the  uealmum  likelihood  estimation  problem  Is  to  determine  the 
smoothing  density  lunation  and  than  to  find  thtt  value  which  maximises  the  value  of  that  funotlon;  this  must 
be  done  for  etoh  value  of  t  In  the  smoothing  Interval,  In  this  Motion,  the  teohntqus  of  expressing  t  density 
function  In  terma  of  quasi -moments  la  briefly  described,  and  the  reader  H  then  referred  to  Peller3  for  further 
Information  on  this  approach.  The  material  contained  In  tht*  section  la  almost  entirely  derived  from  Piaher' s 
eork',  particularly  as  presented  In  Reference  10.  In  feot,  this  section  should  elmply  be  ooneidereri  ee  e 
selective  abridgment  of  Piaher'  e  work. 

Let  p!g,t)  be  an  n -dimensional  denatty  funotlon,  and  let  p((^,t)  be  an  n-dlmenelonel  density  funotlon 
having  the  team  mean  and  ooverlanot)  as  p(y,  t)  ,  Let 

p(M.t)  •  *■  .  (4.19) 

P,(u,t) 

Then,  the  ooetfloientm  of  the  expansion  of  pin, t)  In  ■  eerleu  of  multi-dlmenelonel  Hermits  polynumltla  are 
the  eo-oalled  quasi-moment  functions,  Binoe  the  multl-dlmennlunal  Harmlte  polynomials  era  a  complete  set  of 
•lien- funotlon*  ovar  n-dlwenslonsl  Euclidean  apaoo,  any  probability  donelty  function  oon  be  wrlttsn  as  s  eerles 
of  the  me  polynomials,  provided  x'(ji.t)  la  aquare-lntegrable,  l.e..  If 
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It  la  alio  possible  to  approximate  p(fi.t)  ,  If  It  satisfies  Equation  (4.  20,  tu  any  specified  accuracy  in  tho 
integrablo  square  error  senna  by  a  finite  number  of  terms  In  the  aeries. 


Denotln*  the  earn  aiul  eovsrianoe  by  of t>  and  C(t)  ,  respectively,  and  the  characteristic  functions  of 
p(M.t)  and  Pjfjj.tl  by  <£(«,t)  and  d^fct.tl  ,  raapootlvaly,  F’lahor  aho»a  that 


pttf.t) 


(-1)' 

Nt 


J .  k.  . 


J  ■  k, . 


_ 3*0, (M.t) 

. <Vj 


(4.21) 


■here 


1  3Nfo(a.t)/<f  (a.t)] 

— U  •  -  — ■  — 1  — - 

i  a&j,  3^^ ....  3cij 


a«o 


(4.22) 


art  the  quasi -moment  functions  of  order  N  .  It  can  easily  be  shorn  that  all  quasi-momenta  of  first  and  second 
order  are  aero, 


Because  the  multi-dimensional  Hermlte  polynomials  corresponding  to  the  n  *  n  matrix  C"'(t)  are  related 
to  t  generating  function  aa  follows, 


HJik . ttt±, t)  *  (- n w»xp , 


3m j.  3M|, . 3m j 


(4.23) 


J  =  1,2 . n 

1  =  1,2 . . 

It  le  possible  to  rewrite  Equation  (4. 22)  in  terms  of  the  multl-dlmeneional  Hormlto  polynomials: 

n 


p(M.t)  a  P|(M,  t) 


1  + 


Ir  Z  Kj,k . i“>  Hj,k . .  Cm  -  mft» .  *1 


H«j  Nl  j.k . !•» 


(4.24) 


Equation  (4.24)  shove  that  any  probability  density  function  oan  bo  expressed  dlrsotly  In  tarns  of  the  mean, 
oovarlance.  and  quasi -moment  function!.  Equation  (4.24)  oan  be  the  basis  of  an  approximation  for  the  smoothing 
density  function,  a(y,t)  .  Feller1  gives  the  btslo  development  for  this,  although  it  le  so  tedious  that  parte 
of  It  are  only  outlined,  in  terms  of  the  required  procedures.  Wills  there  ere  certain  advantages  to  the  quasi- 
moment  expansion  of  Equation  (4.24).  Its  use  for  the  smoothing  problem  Is  not  recommended,  end  it  will  receive 
no  further  dlecuaalon  here. 


».  CONCLUSIONS 

This  chapter  has  developed  the  exeot  (In  the  mein-squire  sense)  differential  equations  for  tha  amoothlng 
density  function  and  tha  amoothed  axpectatlon  of  an  arbitrary  function  of  ths  state.  These  results  vers  good 
for  nonlinear  systems  and  observations  corrupted  by  additive  geueslan  white  nolee  and  wtra  extended  to  tha 
produot  noise  case.  In  Section  3,  approximate  differential  equations  were  presented  for  minimum  variance  smooth¬ 
ing,  although  It  wee  assumed  that  the  plant  noise  wee  not  e  function  of  the  state  for  this  oeee.  One  technique 
of  maximum  likelihood  smoothing  wet  presented  and  another  suggested. 

Tbs  equations  developed  In  this  ohector,  particularly  toe  minimum  variance  aquations  of  Section  3,  should  bt 
useful  whanavtr  probaballstlc  smoothing  of  data  la  daslrsd,  such  as  In  estimating  missile  guidance  system  accuracy 
from  nolty  tracking  date.  Whereas  statistical  smoothing  of  data  sometimes  requires  many  pastes  over  the  date 
or  many  Iterations  to  fit  some  polynomial  to  the  date  In  a  least  squares  fit,  the  technique  presented  here 
requires  lust  two  passes:  one  pees  forward  to  get  the  filtered  solution,  and  a  second  pass  backwards  to  get  the 
■southed  lolutlon.  The  forward  pasa  should  probably  use  non! Inter  filter  theory  suoh  as  that  presented  by 
Qohwartz*  to  obtain  maximum  value  from  the  approach. 

There  ere  certain  unresolved  questions  regarding  the  results  presented  In  this  chapter.  On*,  all  results 
have  beon  derived  formally:  little  regard  to  mathematical  rigor  has  been  given.  The  questions  of  existence  and 
uniqueness  of  solutions  to  the  various  dlfferentlel  equations  have  not  been  treated.  In  any  area  dealing  "’ith 


stochaatla  processes,  this  could  bo  &  serious  omission  since  relatively  little  Is  known  shout  the  conditions 
necessary  to  fuarantse  silstence  anil  uniqueness  of  solutions.  Another  question  Is  the  sensitivity  or  the 
results  to  uncertainties  in  the  knowledge  of  tho  plsnt  tnd  of  tho  vorious  covarinneo  matrices  Involved.  Thuso 
types  of  uncertainties  ere  known  to  be  potentially  very  serious  in  filter  theory;  some  of  theso  problems  are 
treated  elsewhere  In  this  publication. 


ACKNOWLEDGMENT 

Much  of  the  work  oontalned  In  this  paper  was  supported  by  various  trants  by  the  United  States  Air  Pores  and 
a  North  American  Rockwell  fellowship. 


REFERENCES 


1.  Doob,  J.L.  Stochastic  Processes.  Wiley,  New  York,  196b. 

2.  Strlebel,  C.  T.  Partial  Differential  Equations  for  the  Conditional  Distribution  of  a  Harkov  Proces 

Given  Noisy  Observations.  Journal  of  Mathematical  Analysis  and  Its  Applications, 
Vol.ll,  No.  1-3.  July  1965,  pp.  15 1- 190. 

3.  Peller,  John  B,  Nonlinear  Smoothing  Theory  and  Applications.  PhD  Thesis,  University  of  California 

Lis  Angelas,  1968. 

4.  Buoy,  It. S.  Nonlinear  Filtering  7h«ory.  Institute  of  Electrical  and  Electronic  Enilnssra, 

Transactions  on  Automatic  Control,  Vol,  10,  No. 2,  April  1965,  p, 198. 

« 

5.  Biss,  R. w,  Optimal  Multi-Channel  Nonlinear  Filtering.  Hughes  Aircraft  Company,  Culver  City, 

st  si,  California,  Report  880  50064R,  August  196b. 

6.  Bohwartz,  L.  Approximate  Continuous  Nonlinear  Stininal-Variance  Filtering.  Hughes  Aircraft 

Company ,  culvsr  City,  California,  Raport  SBC  60472R,  Dacsmber  1968. 

7.  Plahsr.  Janes  R.  Conditional  Probability  Density  Function s  and  C^tinal  Nonlinear  Estimation.  PhD 

Thesis,  Unlvsrslty  of  California,  Los  Angsles,  1966. 

B.  Rauoh,  H.E.  On  the  Maximum  Likelihood  Estimates  for  Linear  Dynamic  Systems.  Lookhesd  Aircraft 

•t  al,  Corporation,  Sunnyvale,  California,  Teohnloal  Roport  8-90-63-62,  June  1963. 

B.  Bryson,  A.E.  Smoothing  for  Linear  and  Nonlinear  Dynamic  Systems,  Publlihsd  In  ths  Procsodlngs 

Praslsr,  M.  of  th*  “Optimum  System  Synthesis  Conference"  ,  Aeronautical  Systems  Division, 

USAT,  September  11-13,  1902,  (Also  Wrtght-Pattereon  Air  Poroe  Base,  Ohio,  ASD 
Technical  Documentary  Report,  A8D-TOR-83- 119,  February  1963,  pp. 334-364. ) 

10.  Plaher,  J.R.  Optimal  Nonlinear  Filtering,  pp, 197-300  In  “Advances  In  Control  Systems”,  Vol. 5 

(edited  by  C,  T.Lecndee) ,  Academic  Press,  New  York,  1967, 


vw 


CHAPTER  10  -  OENERAL  QUESTIONS  ON  KALMAN  FILTERING 
IN  NAVIGATION  SYSTEMS 


^■S/AyW 

..A.'  *.’  • 

a  *  fc  i  ■  *  ,•  ■ 

i *  O  v’  •.  •.  ; 

’•  ,*>  t  -  ■  •  • 

►  --V^V-V-VA* 

*  M  '*,4  »*  -* 

Vv  v  v.- .■/.*.  v. 
,v.v.v.v.:.-.v.y. 

l"V**0TrYV'r^>"y'" 

Xv/Xv^Xr,:* 

.  •  .  •  .  ■  -  •  • 
4  *  »  -  «*r  <' 

»  *1.  •  .  '  4  V' 

s  m M-_'*  * 

lw.M 

■  "'•■■  i-ylyS- 


Larry  D.  Brook*  and  Btorgi  T.Sohaldt* 


*  Aii litftot  Dacian  Projact  Eniintar 
Hanilton  Standard 
flaralnaton,  Connecticut,  USA 

*  Principal  biilnur 
Inatruacntatlcn  Laboratory 
Maaaaohuaatta  Initltuta  of  Taohnolofy 
Caabrldia,  Kaaaachuaatta,  USA 


.v/iT.’vvv! 

.  ,'jCV.V.  «  » 


L>  v«  ■»“  O  *'  ■ 

V,--V-V"V- V- 

fy.y. <■». y.  \ 

K**v'-Vv'*:*%>V 

^  i  '«  .  %  iU  V<'^2«aM4 


*'..%:-:vv:-;y:yi*j 

.  «■.  •.■T- *  v'J 


PRECEDING  PAGE  BLANK 


P  .  ■  •  '  *  ‘  -  ’a* 

IV  ’  •  V 
>  V  V- 

•  •  *  «’V  V  \«  V  \.r 

•'-  S'  * 


I  w V“  «_■**“-'*  »  '  N 

*  »  "  * «  a  *•  »  *  »  *  -  *  a.  • 

’•V'Y^Y-V-Y-Y  >' 

:«'.■*  .vY-v '•>' v-v 

■Y'.'S'v 


JOS 


.3  '  •  ■’v 


CHAPTER  10  -  GENERAL  GUESTIONS  ON  KALMAN  FILTERING 
IN  NAVIGATION  SYSTEM!! 

Lorry  0. Brook  and  Ooorge  T. Schmidt 


1.  INTRODUCTION 

Novliotlon  eyitocis  oro  omong  the  moot  popular  treao  lur  the  spplleatlon  of  Kalman  filtering.  Must  of  the 
major  navigation  nystem  manufacture™  have  developed  or  proposed  systems  with  Kalman  filtering,  and  It  Is  being 
used  In  several  vehicles  that  are  In  operational  use.  Two  examples  are  the  Apollo  space  vehicle  and  the  C-SA 
transport  alrorsft.  Kalman  filtering  has  now  become  an  expected  part  <t  almost  every  proposed  new  navigation 
system.  The  reasons  for  the  popularity  of  Kalman  filtering  in  navigation  systems  are  not  hard  to  find.  There 
are  at  least  three  major  complementary  fautors  that  have  coma  togathar  at  the  proper  time.  Thais  fsetors  are 
an  Increased  need,  the  mathematical  tools,  end  the  necessary  equlpsant, 

Tht  nasd  for  affectlva  on-board  data  processing  la  graat  for  both  apace  and  tarrastrlal  vahlolsa,  Tha  advent, 
of  manned  travel  to  tha  moon,  with  the  requirement  for  self-contained  navigation,  required  an  af flolant  mathod 
for  tha  raal-tima  processing  of  ail  navigation  measurements.  In  terrestrial  vehicles  (both  alroraft  and  marina) 
tha  lnortsaad  need  im  caused  primarily  by  the  introduction  of  Jnertlal  navigation  systems  that  havs  vary  good 
high- frequency  response  and  give  a  contlnuoua  indication  of  position,  valoolty,  and  attltuda,  in«,  ire  alio 
•elf-contalnad  and  operate  without  electromagnetic  inputs  or  outputs.  However,  they  do  have  errors  that  grow 
with  tins.  Thus,  for  most  sppllostlons,  thsre  la  t  deslrs  to  bound  the  position  error  growth  with  external 
elds.  Aocurscy  requirements  dlotsts  that  this  sxtsrnsl  dsts  he  processed  as  efficiently  as  possible. 

A  mathsaatlosl  teohnioue  was  developed  at  Juft  the  right  time  to  fulfill  theae  needs.  The  Kalman  filter 
theory,  published 1,1  in  the  early  1900’ i,  waa  recognized  as  an  ideal  solution  to  the  navigation  data  proosaslng 
problems  for  both  space1 •“  end  terrestrial  vehicles'* 10.  These  data  processing  problems  can  be  fitted  very  nicely 
into  tha  necessary  Kdlmin  filter  aasiuptlant,  which  mens  that  the  estimate!  of  the  deelred  navigation  output! 
ire  in  fact  very  nearly  optimum.  Thle  gives  the  design  engineer  confidence  that  the  system  le  the  beet  that  oan 
reasonably  be  expected,  without  the  concern  that  eame  other  technique  might  be  found  that  would  significantly 
Improve  the  system.  Alio,  the  recursive  fee  of  the  filter  it  convenient,  A  new  optimum  estimate  oan  be  side 
very  shortly  after  each  new  aeaaurement  is  ubtslned,  Nor  is  it  necessary  to  store  s  great  amount  of  data  or 
invert  a  large  matrix,  as  might  be  necessary  in  more  conventional,  least-squares  fitting  taobnlquos, 

However,  ts  excellent  a  solution  as  Kalman  filtering  is  to  tbs  data  processing  problem,  it  mould  have  bssn 
of  only  aeadsaio  interest  if  it  were  not  for  the  fantastic  rats  of  development  in  slsotronlo  oircults,  which 
makes  possible  very  powerful  digital  flight  computer*.  Thsia  three  factors  have  cobs  together  at  tht  proper 
time  to  oreate  considerable  lntsrast  In  Kalman  filtering  in  the  nsvlgation  Industry.  This  lntsrsat  partially 
motivated  thle  publication. 

In  this  chapter,  some  of  the  Initial  steps  Decenary  for  the  application  of  Kalaan  filtering  will  be  dieouated 
in  general.  The  application  of  filtering  to  terrestrial  navigation  will  then  be  illustrated  by  simple  examples. 
Tso  methods  era  suggested  for  simplifying  ths  problem  In  order  that  it  oan  he  mors  sully  handled  on  a  practical 
computer.  Details  ere  then. given  of  the  alignment  and  calibration  of  tbs  inertial  system  in  a  spacecraft  on  top 
of  a  swaying  launch  vehicle.  Practical  Implementation  probltss,  at  wall  u  actual  hardware  difficulties,  are 
-  disousatd  In  detail.  '  It  le  hoped  that  from  these  simple  examples  the  reader  will  be  in  e  better  position  to  . 
appreciate  the  epplloetioni  that  follow  In  the  text. 


I.  INITIAL  STEPS  IN  THE  APPLICATION  OP  KALMAN  FILTERING 


Tha  Kalman  filter  lteelf  Is  defined  In  very  precise  eethsmstical  tarsi,  but  its  application  to  actual  physloal 
systems  la  rsraly  a  precis*  science.  Conaiderabli  engineering  experience  is  needed  to  properly  Identify  the 
aystea  to  whloh  the  filter  le  to  be  applied,  to  adequately  model  that  system,  and  then  tn  develop  a  practical 
program  that  atohanizes  the  filter  In  the  on-board  computer.  The  optimization  of  the  filter  must  inolude  many 
factors  which  are  difficult  or  lepoeslble  to  describe  mathematically,  suoh  u  the  trade-off  between  performance 
end  computer  elzw.  Tha  etatlitioel  parameters  are  rarely  based  on  the  actual  etatlitloi  of  the  physical  system, 
because  theae  statistics  ere  either  too  complicated  or  ere  not  well  known.  The  parueters  are  more  likely  to 
be  chosen  fay  lees  formal  methods  whloh  attempt  to  mtxlslze  the  performance  in  spite  of  the  imperfectly  known 
real  world.  For  example,  the  ooverlxnce  matrix  in  the  operational  Kalmen  filter  will  oonteln  an  estimate  of 
the  r.m.e.  position  accuracy  of  the  navigation  aystea.  Beet  performance  le  usually  obtained  If  this  number 
latches  fairly  cloeely  the  actual  r.m.e.  position  accuracy  obtained  by  the  system,  even  if  the  filter  parameter 
euet  be  “adjusted"  to  obtain  this  match.  The  noleei  aeiociated  with  parameters  that  ere  modeled  mifht  be 
arbitrarily  Increased  to  make  up  for  parameters  that  were  too  smell  or  not  well  enoueh  known  to  be  included  in 


the  model. 
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On*  of  the  flrat  steps  In  applying  Kalman  filtering  le  to  Identify  the  eyetom  on  which  tho  filter  is  to  bo 
bu*d.  Tho  oholco  of  eyetom  le  not  ae  obvloue  an  it  might  Boom,  Tho  moot  direct  approach  la  to  eatlmato  the 
doalred  parameter!  of  tho  vehicle  directly.  A  functional  diagram  of  thin  approach  le  ehown  in  Figure  1.  The 
primary  eyetem  on  which  the  filter  le  baaed  la  tho  eyntom  of  equations  that  dencrlho  tho  motions  of  the  vehicle 
itself.  Thin  direct  method  is  usud  In  apace  navigation  syntonic.  This  approach  c>  ilu  also  be  used  in  terrestrial 
navigation  systems  where  the  Kalman  filter  uses  all  measurements,  including  inertial  measurements,  to  produce 
estimates  of  tho  position  and  velocity  of  the  vehicle  directly.  However,  for  praotloal  reasons  whloh  will  bo 
discussed  later,  an  Indirect  method  le  usad  where  tho  filter  eatimatee  tho  error  In  an  lnortlal  navigation 
ayatem.  The  correotsd  inertial  output  la  then  usad  to  Indicate  the  position  and  velocity  of  the  vehicle.  In 
thia  caae,  the  lyatem  on  which  the  filter  la  based  la  the  one  whloh  describes  the  errors  In  the  Inertial  system, 

A  functional  diagram  is  shown  In  Figure  2. 

The  system  on  whloh  the  filter  Is  to  be  based  Is  specified  by  a  sat  of  state  variables  that  are  defined 
formally  by  a  set  of  mathematical  rotations.  In  practice,  for  actual  physical  systems,  there  la  never  enough 
Information  to  satisfy  these  mnthemutlcal  relations  perfectly.  Further,  It  la  never  practical  to  Include  more 
than  a  few  of  the  major  variables  In  the  on-board  computer.  One  of  the  basic  design  problems  la  the  choice  of 
state  variables  for  tho  navigation  filter  and  tho  tRsoolated  trade-off  of  performance  versus  computor  requirements. 

As  t  first  stop  In  the  choice  of  state  variables,  theoretical  error  analyses  and  test  data  can  be  used  to 
construct  s  set  of  stste  variables  which  doscribo  the  total  system  much  more  accurately  than  the  deacrlptton 
expected  from  the  on-board  filter.  For  a  terrestrial  navigation  system,  this  more  complete  description  could 
require  ss  many  ns  fifty  to  sixty  stats  variables  with  many  more  which  could  be  identified  but  tra  not  worth 
considering.  The  performance  cf  filters  based  sn  various  limited  sets  of  stste  variables  can  than  ba  evaluated 
by  using  computor  simulations  based  on  the  more  oomplote  modal.  One  Is  ohoson  whloh  is  shown  by  the  simulations 
to  bost  satisfy  tho  system  requirements.  For  terrestrial  systems,  praotloal  filters  have  consisted  of  between 
revgb  and  twenty  itite  variables.  An  effective  operational  teat  program  le  the  only  way  to  definitely  confirm 
the  design  of  tha  filter. 

Tbs  mathematical  relatione  whloh  glva  the  formal  definition  of  the  etnte  variables  ere: 

(a)  The  desired  output  must  bo  tome  funotion  of  the  stats  variables. 

(b)  The  measurements  must  bt  a  funotion  of  tha  atata  variables  and  uneorrelated  trrora. 

(o)  The  state  variables  at  one  time  must  be  a  function  of  the  state  variables  at  a  previous  time,  the  control* 
to  the  system  between  the  two  times,  and  the  uncorrelated  (white)  nolne  inputs  betweon  the  two  time. 

Tbs  first  relation  can  usually  be  satisfied  very  enelly.  The  desired  output  of  t  navigation  system  is  the 
position,  velocity,  and  possibly  attitude  of  the  vehiole  with  respect  to  scale  navigation  coordinate  frame,  The 
variables  whloh  represent  position  and  velocity  eon  usually  be  included  directly  in  the  state  spaoe.  The  second 
relation  Involving  the  measurements  nan  b*  more  difficult  to  foruulsts.  The  measurements  will  generally  oonalst 
of  two  parts:  s  desired  pert  whlob  Is  ease  funotion  of  the  states  of  the  vehiole,  euoh  ts  position,  veloolty, 
or  acceleration;  and  an  undeslrad  error.  An  error  whloh  otn  be  ooneldered  unoorrelated  between  measurements 
dose  not  require  *ny  .additional  state  variables.  However,  If  there  are  significant  components  of  the  error 
which  are  correlated,  the  model  for  the  error  suet  be  added  to  tbs  state  variables. 

The  moat  effaotlve  overall  design  of  the  eyetem  otn  usually  bt  obtained  by  minimizing  the  amount  of  prt- 
sroceiiini  of  the  input  data  baforo  It  la  used  In  the  filter.  One  advantage  of  Kalman  filtering  it  that 
mtasuraments  can  bt  proossstd  in  rtw  form;  this  a an  greatly  simplify  the  sensor  sub-systsme.  For  txtmpls,  If 
on  inertial  aystsm  le  to  be  aided  by  LORAN,  it  is  not  necessary  fur  tha  LORAN  equipment  to  solve  for  a  position 
flz,  whloh  has  then  to  be  Inserted  In  the  filter  to  update  the  Inertial  ayatem.  The  filter  otn  be  constructed 
to  sooept  tins  dlffersnct  measurements  directly,  thus  simplifying  the  LORAN  equipment.  Another  advantage  of 
processing  the  raw  measurements  la  that  the  model  tor  measurement  error  can  ba  much  simpler,  If  the  measurements 
are  processed  before  being  used  by  the  filter,  the  modifications  and  orosa-aorralatlona  of  thu  error  atatlstloa 
caused  by  tha  prsprootaslng  must  ba  sooountsd  for  by  ths  filter,  Again  using  LORAN  aa  an  example,  ths  errors  in 
tins  differences  can  probably  be  edequatsly  modeled  ss  simple  errors  with  no  oross-oorrslatlons.  Ths  errors  In 
latitude-longitude  coordinate  would'  be  complicated  functions  of  LORAN  atatlon-vehiole  geometry  end  they  would 
be  orugi-eurrelated. 

The  final  step  In  tha  forming  of  th*  state  vector  le  the  addition  of  any  variable*  neetiaary  to  deaorlb*  tha 
dynamic  behavior  uf  Ilia  state  variables.  The  totel  set  of  etste  variables  le  the  minimum  number  of  dependent 
variables  in  the  differential  aquations  that  describe  the  system.  The  inputs  to  the  aystsm  can  only  be  white 
.  noises  and  control*  which  era  deterministic  quantities  that  are  known  to  thu  filter.  Mery  cf  thu  basic  sources 
of  error  lu  navigation  systems  or*  very  highly  autooorrslatad  aa,  for  example,  gyro  drift  rats,  To  satisfy  ths 
requirement  for  whits  noise  Inputs,  e  shaping  flltar  must  be  devised  whloh  produoes  the  desired  correlated  error, 
lbs  iaput  to  the  eheplng  flltar  is  white  noitt,  and  the  dependent  variables  In  the  shaping  filter  era  added  to 
the  stats  space,  if  tbsrs  ar«  controls  Into  ths  ayatem  whloh  are  not  known  quantities  available  to  the  filter, 
they  too  would  have  to  be  modeled  ss  random  noise. 

Several  general  oommnts  will  now  be  mede  about  the  formulation  of  ths  state  variables  for  space  and  terres¬ 
trial  navigation  ayatama.  Th*  Kalnan  filter  for  a  space  navigation  ayntem  la.  In  many  ways,  mors  straightforward 
than  for  a  terrestrial  system.  Ths  desired  outputs  ere  ths  position  and  velocity  vectors  of  ths  vehiole;  this 
requires  six  state  variables.  Th*  measurement*  usually  consist  of  optlosl  angular  measurements  between  oelentlal 
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bodies  end  aru  function*  of  vehicle  position.  The  optical  measurement*  are  usually  relatively  far  apart,  an 
that  coat  of  the  error  la  unoorrelatod  with  the  previous  error.  In  many  cane*  the  correlated  part  of  the  error 
will  ba  lnalinlflcant,  and  nn  additional  state  variable  will  bo  required.  In  othor  altuatlnna,  one  additional 
variable  might  bo  required.  The  inertial  measurements  made  in  a  spacecraft  are  obtained  only  during  thrusting 
maneuvers,  During  this  time  there  would  not  normally  be  any  other  source  of  data  on  the  change  in  velocity. 

Thus,  the  inertial  mecinursaen'  Is  taken  as  a  deterministic  control  quantity  and  la  not  flltorcd.  The  dynamic 
aquations  for  a  apace  vehicle  ere  also  clear  cut,  If  the  position  and  velocity  of  a  apace  vehicle  arc  known  at 
one  time,  the  position  and  velocity  for  any  future  time  cun  be  predicted  with  greet  accuracy,  The  uncortaintlen 
due  to  tolar  and  atmospheric  pressures,  gravitational  field  uncertainties,  and  computing  inaccuracies  are  very 
small  unless  the  vehicle  la  in  a  low  orbit.  Thus,  the  dynamic  bohavlor  can  be  described  with  the  all  basic 
variables  with  possibly  a  small  amount  of  white  noise  input  to  account  for  all  the  disturbances,  Therefore,  for 
an  on-board  space  navigator  with  negligible  correlated  measurement  errors,  tho  entire  filter  can  be  baaed  very 
nicely  on  six  etate  variables, 


Tho  filter  for  a  terrestrial  system  Is  not  nearly  aH  clear  out.  The  desired  outputs  are  ogaln  position  end 
velocity.  Tho  measurements  can  come  from  inort'ial  sensors,  Doppler  radar,  and  a  great  variety  of  othor  aids. 

The  errors  in  any  of  those  seniors  arc  very  highly  correlated  In  time.  The  Inertial  instruments  will  add  at 
least  six  variables  -  three  attitude  errors  ami  three  gyro  drift  rates  -and  possibly  more  for  errors  such  as 
scale  factor  errors  and  acceleration-sensitive  gyro  drifts.  Tho  Dopplor  would  require  at  louat  two  variables 
for  seals  factor  and  boroslght  errors.  Tor  radio  aids,  the  sample  period  msy  bo  long  enough  for  correlated 
errors  to  be  neglected,  The  dynnmic  equations  are  the  source  of  considerable  difficulty  If  the  Kalman  filter 
la  to  ba  used  In  the  diroot  approach  as  shown  In  Figure  1,  Thia  direct  formulation  requires  that  a  statistical 
dynamlo  model  for  tho  vehicle  ba  included  in  the. state  space.  While  the  future  state  of  a  spacecraft  can  be 
predicted  accurately  for  weeks,  the  future  position  of  an  aircraft  dan  be  predicted  accurately  for  only  a  few 
seconds.  The  model  used  to  describe  these  random  motions  la  difficult  to  obtain,  contains  very  high  frequency 
components,  and  can  ba  highly  nonlinear.  A  direct  filter  for  a  terrestrial  system  Is,  therefore,  difficult  to 
formulate  and  puts  great  demand  on  tha  computer,  Thus,  although  this  direct  filter  approaoh  la  mors  intellectu¬ 
ally  satisfying,  at  tha  present  time  it  la  mors  of  academic  interaat  than  of  praotloal  Importance, 

Evon-though  thla  direct  approach  may  not  ba  practical  until  more  powerful  computer*  art  available,  the  formu¬ 
lation  of  tbs  navigation  problem  using  this  method  can  be  very  instructive  and  aid  In  tha  basic  understanding 
of  both  tha  filtering  procoaa  and  the  navigation  prooens,  This  filter  will  give  the  optimum  performance  of  an 
inertial  navigation  syatem  even  if  no  external  data  are  available.  Thla  means  tha  Kalman  filter  automatically 
solves  soma  of  the  elaastoel  problems  In  inertial  navigation.  Optimum  gelf-oontained  “damping'’  of  the  84-minute 
and  24-hour  error  oscillations  will  bo  obtelhsd,  end  tho  syatem  will  give  the  optimum  indloetlon  of  North  hy 
eontlnuoualy  “gyrocompasslng",  These  mtatamsnte  ars  not  as  important  as  they  might  seam.  It  turns  out  that, 
for  tha  levtls  of  random  motion  that  must  be  aagumad  for  moat  vahlolaa,  the  optimum  solution  la  only  vary  slightly 
better  than  tha  deterministic  solution  of  the  navigation  problem  that  has  been  used  all  along.  The  filter  oan 
only  improve  performance  by  separating  tha  accelerations  due  to  syatem  errors  from  tha  aotual  aaoalarationa  of 
tha  vehicle.  The  ayatem  errors  do  have  distinctive  dynamlo  characteristics  which  moke  detection  possible;  however, 
their  magnitudes  are  so  much  smaller  than  the  accelerations  of  th*  vehicle  that  they  ars  very  difficult  to 
separate.  If  any  improvemant  oould  be  expected  at  all,  it  would  be  for  a  syatem  In  a  very  stable  vehicle,  such 
as  a  aubmarina. 


Thla  dlraot  filter  will  also  give  optimum  performance  whan  other  aouroea  of  navigation  information  are  added 
to  th*  lnartlal  dsta,  and  even  wnan  there  ar*  only  external  aids  with  no  Inertial  data.  For  example,  this  filter 
oould  ba  uaad  to  combine  Doppler,  LORAN,  and  magnetic  heading  Information  without  uning  an  Inertial  system.  It 
therefore  hu  the  advantage  of  continuing  to  operate  after  a  failure  In  the  inertial  ayatam. 

If  th*  navigation  ayatam  doss  Include  an  lnartlal  ayatam  and  some  other  nouro*  of  navigation  data,  there  la 

a  completely  dlffarant  way  of  formulating  the  navigation  problem  which  avoid*  most  of  tha  praotical  problem*  of 
th*  pravloua  method,  Inataad  of  estimating  the  atate  of  th*  vehicle  directly,  th*  filter  1*  ueed  to  estimate 
tha  error  stats  of  an  Insrtlal  navigation  system.  The  Inertial  ayetem  follow*  the  high-frequency  motion*  of 
tha  vahlol*  very  accurately,  but  hat  low-fraquancy  error*  which  grow  with  time,  ’  Th*  dynamic  ayatam  on  which  th* 
flltar  la  baaed  la  th*  set  of  trror  aquation*  for  th*  Inertial  ayatem,  which  tr*  relatively  well  known,  wall 
behaved,  low  frequency,  and  aaaantlally  linear,  Tb*  sample  period  oan  range  from  several  aeoonds  up  to  a  minute 

without  greatly  Influencing  tha  af/eotlvanaa*  of  th*  filter.  For  these  reasons,  this  method  is  uaad  for  virtually 

tvary  praotloal  terrestrial  Kalman  filter  maehanicatlon, 

Tha  formulation  of  a  Kalman  filter  for  terreatrlal  navigation  oan  best  be  illustrated  by  simple  examples. 
Therefor#,  both  method*  ar*  applied  to  a  simplified  navigation  problem:  tha  specific  flltar  equations  ar#  defined, 
and  simulation  result*  are  given.  First,  at  th#  rlak  of  being  repetitious  with  pravloua  chapter*,  th#  basic 
Kalman  filter  aquations  are  stated.  The  aquations  ar#  stated  la  the  form  moat  ipplicebl#  to  the  navigation 
problem  and  art  a  mixture  of  the  dlgcrete  form  and  th*  oontlnuoua  form,  Th#  discrete  form  la  uaed  when  a  naw 
measurement  la  Introduced,  and  tho  continuous  fora  la  used  batwaan  measurements.  Tha  aquations  era  also  a  mixture 
of  Unaar  and  nonlinear  equation#,  th*  full  nonlinear  equation#  being  ueed  for  th*  elmulatlon  of  the  syatem  and 
of  th#  measurement  process.  Linearization  of  these  aquations  about  tha  eotimated  atata  la  uaed  for  th#  covariance 
matrix  equations. 
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3.  SUMMARY  OF  BASIC  FILTER  ERUATIONS 

It  i>  earned  that  the  state  of  the  entire  eystem,  Including  senaora,  vahlcla,  and  envtronaent,  oan  bo 
dweorlbed  by  differential  equations  of  the  form 

i(t)  Xt*(t),  S(t).  u(t),  t]  .  (3.  1) 

where  s  are  known  oontrol  lnputa  and  fl  are  white  nolaea.  For  the  aeeuaptlona  to  be  made  hero,  li  can  be 
nhown  that  the  oontrot  done  not  affect  the  fora  of  the  optimum  filter,  Thua,  tho  control  varlablun  will  not  be 
shown  explicitly  In  the  followlni  discussion.  It  Is  aaauned  that  measuremanta  arn  made  at  discrete  times 
aceordlns  to  the  relation 

Bit,)  s  htx(t,l,  U<t,)]  ,  (3.2) 

where  ||(tB)  are  errors  In  the  measurements  that  are  uncorrelated  between  moaourements.  (Time-correlated  errors 
In  the  measurements  would  have  to  be  lndudod  In  the  state  veotor  {  .)  Assumlim  that  the  optimal  estimates 
are  nloae  enouih  to  tho  truo  values  for  hither-order  terms  to  be  neslaoted,  tho  optimum  measurement  process  is 
(lven  hy  Kalman’s  optimum  linear  filter,  Tho  basic  equations  are: 

At  a  ntnturtmen t  time 

£  =  i'  +  e'ht(iie'ht  +  ur  l(n  -  b(s',t)) 

E  s  E'  -  B'HT(HE'HT  +U)'lHE' 

Between  oeaeureaente 

X  »  l(i  t) 
i  >  nt  +  irT  +  n  , 


(3.3) 


where  the  prime  (')  indicates  oondltlone  that  exist  just  before  the  measurement.  Tht  covariance  matrix  of 
estimation  errors  E  Is  defined  by 

B  w  (Jj  , 

where  "<  >"  represents  the  expected  or  mean  value,  la  the  error  In  the  estimate,  and 
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The  matrices  R  and  Q  are  defined  by 


(]|(ta)u(ta)*>  =  R 
4Kt)fl(T)T>  3  QS(t-r)  . 


The  optimum  filter  for  a  linearised  system  in  whloh  the  hither-order  terms  can  be  netleoted  it  shown  in  dlacram 
fora  In  Flture  3,  where,  at  the  sample  times,  the  estimate  of  the  state  i  la  ohanted  by  an  Impulse  through 
the  weight  Ini  faotor,  K  w  i'ht(HE'Ht  +  U)"‘  , 


4.  ILLUSTRATIVE  EXAMPLES 

loth  the  direst  and  indlreot  forms  of  the  Kalman  filter  are  Illustrated  by  applying  then  tlo  similar  simplified 
navliatlon  problems.  For  this  example  the  vehicle  Is  constrained  to  move  only  along  a  meridian  on  the  surface 
of  a  spherical  non-rotating  earth.  The  vehiole  is  disturbed  by  random  aaoelaratlons  with  gausslan  distribution 
and  an  exponential  autocorrelation  function.  Inertial  measurements  are  obtained  from  an  aoaaleroeieter  that  is 
mounted  on  a  platform  that  rotates  about  an  ails  perpendicular  to  the  meridian  plane.  The  orientation  of  the 
platform  is  controlled  by  a  nlngle-degree-of-freedom  gyro.  Hie  platform  oan  be  commanded  to  rotate  at  a  given 
rate  hy  a  signal  sent  to  the  gyro,  and  it  will  alec  rotate  due  to  gyro  drift.  The  gyro  drift  rate  is  assumed 
to  be  a  random-walk  funotlon  beginning  at  some  Initial  bias  value.  The  aooelerometar  measurements  are  used  by 
the  direct  filter  to  produoe  et at  let leal  estimates  of  the  position  and  valoolty  of  the  vehiole.  For  the  Indlreot 
foraulatlon,  the  aooelerometer  output  Is  connected  directly  to  the  gyro  through  the  proper  gain  to  give  a  deter- 
miniatio  Behuler-tunsd  Inertial  navigator.  Tha  measurement  in  this  ease  la  tha  dlfferanoe  between  Inertial 
veloolty  and  valoolty  from  a  Doppler  radar,  Tht  Doppler  radar  la  assumed  to  have  a  aoale  faotor  error  that  la 
alio  described  by  a  random-walk  from  an  initial  bias  valut.  A  soheaatlo  drawing  of  tha  navigation  problem  with 
the  direct  filter  le  shown  in  Figure  A.  The  diner sm  for  the  Indlreot  formulation  la  basically  tha  asms  except 
that  Doppler  data  la  also  an  input  Into  the  computer. 
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Tlio  atepa  for  apply  ins  «  ttatietlral  filter  art:  (11  choose  tho  state  variables  that  descrlbo  the  cooploto 
system;  (2)  determine  the  dynamic  equations  that  doaorlbo  those  atata  variables;  (3)  derive  the  equations  that 
relate  the  measurements  to  tho  state  variables;  (4)  develop  tho  matrices  of  partial  derivatives  that  are  lined 
la  the  eovariance  matrix  equations  ;  and  (S)  If  it  oui  be  nnouned  that  the  linear  approximations  of  the  errora 
are  sufficient  and  that  all  signals  and  Initial  conditions  hava  gsussltn  distributions,  apply  liquations  (3.3). 
These  steps  are  first  applied  to  the  direct  form  of  the  filter, 


The  stats  variables  that  describe  this  simplified  navigation  problaa  ars  vehicle  acceleration  a  ,  velocity  v  , 
latitude  L  ,  platform  misalignment  from  vertical  a  ,  and  gyro  drift  rate  d  .  A  diagram  of  the  system  Is  shown 
In  figure  5.  Tho  numbers  at  the  output  of  the  gains  K  mean  discrete  changes  ars  made  at  tho  corresponding 
points  In  tha  system  at  the  sample  tlmoi.  The  aquatlona  describing  the  dynamics  of  these  variables  art 


a  *  -  an  +  nt 

v  c  a 

£,  =  V/R 

a  =  v/R  +  d  ♦  o 


(«,1) 


where  a  Is  the  Inverse  correlation  time  of  thm  vehicle  acceleration,  R  la  the  radius  of  the  earth,  and  na 
and  dj  are  tha  whits  noise  inputs  Into  th*  models  of  vshiclt  acceleration  and  gyro  drift  rata,  respectively. 
The  a  equation  darlvos  from  the  foot  that  tha  platform  la  rotated  by  $/R  in  order  to  keep  It  aliened  with 
tha  vertical  while  tho  true  vertical  rotates  by  v/R  ,  Tha  platform  la  alee  torquod  by  3  to  coeipenaate  for 
tha  gyro  drift  rate  d  ,  Tha  known  control  e  la  therefore  -  C/R  -  3  ,  The  equations  for  tha  estimated  state 
variables  are  tha  aims  as  Equations  (4. 1)  with  tha  actual  state  variables  replaced  by  tha  aotimatad  variables 
and  tha  noiao  terms  deleted.  Note  that  bananas  of  o  ,  3  and  a  are  sero, 

The  measurement  of  tha  accelerometer  la  (Ivan  by 

m  •  a  cos  a  t  [g  -  (vVR)}  sin#  +  n„  ,  (4.2) 


where  I  la  tha  acceleration  of  gravity  and  n(  la  unoorrelated  nolaa  in  tha  measurement, 


The  t  and  H  matrices  are  obtained  by  taking  the  partial  derivative#  of  Equation!  (4,1)  end  (4.2)  with 
respect  to  tha  state  variables,  Tha  r  matrix  la  given  by 


and  tha  H  matrix  by 


P 


-O’  0  0  0  0 

i  0  0  0  0 

0  V 1  0  0  0 

0  IT 1  0  0  1 

_0  0  0  0  0 


H  =  [l  0  0  [f  -  (?'•/»>]  o]  , 


(4.3) 


(4.4) 


In  tha  aquation  for  H  ,  tha  anile  a  lw  small  such  that  cob  a  can  be  assumed  1  and  tarns  Involving  sin  a 
can  be  neglected  as  aacond  order.  The  nolaa  matrices  ars  given  by 

'*  0  0  0  o" 

0  0  0  0  0 

N  a  0  0  0  0  0  , 

0  0  0  0  0 

0  0  0  0  D_ 

■bars  A  and  D  are  defined  hy 

<n,(t)  r,(t)>  w  Al(t-r) 

<n4(t)  n4(r))  a  D  S(t  -t)  , 

and 

U  *  (nj>  . 

All  terms  art  now  dsfinwd  ao  tha  optimist  filter  for  this  problem  is  eowletaly  defined  hy  Cqustlons  (3,3). 

An  exsaplt  of  ths  response  of  this  meridian  system  to  typical  Inputs  la  given  in  figures  0-9.  The  three 
sources  of  disturbances  lh  th*  nyatam  art  tha  random-walk  gyro  drift  rats,  tha  disturbance  acceleration,  and 
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th*  .random  measurement  error,  Tho  rsndoci-walk  gyro  drift  Increases  thu  r.m.s,  drift  by  0.08  »oru/hr|/’.  (A  mnru 
li  approximately  0,018  deg/hr.)  Tho  disturbance  acceleration  has  an  r.n, a.  value  of  0.003  ft/aec*  and  a  correla¬ 
tion  tlno  of  1  min.  The  random  measurement  error  has  an  r.ra.a.  value  of  0.001  ft/aec*.  Tim  sampling  period 
for  the  measurement  la  1  aec.  Alan  shown  for  the  same  inputs  era  tho  responses  of  a  Schuler-tunod  undamped 
system  end  a  system  with  load-lag  damping.  Thu  accelerations  of  thn  vehicle  In  stcady-atate  motion  between 
maneuvers  used  In  this  example  are  optimistically  small  oven  fur  a  very  stable  vehicle  such  as  n  eulmarlne.  As 
tho  noieo  lncroanus,  tho  performone*  of  tho  optimum  system  approaches  very  rapidly  tho  performance  of  n  dotor- 
minliUc  Schuler-tunod  system.  Huaever,  thin  example  doom  show  that,  improvement  Is  at  lonet  theoretically 
possible, 


A  Kalman  filter  la  again  applied  to  essentially  the  some  navigation  problem  exaept  that  thn  Indirect  approach 
Is  used.  Tho  Inertial  ayntem  la  mechanised  In  a  closed  Schuler  loop  and  the  filter  uues  Doppler  data  to  estimate 
inertial  errors.  The  state  variables  that  duncrlbu  the  error  equation!)  to  which  the  filter  Is  to  be  applied 
are;  Doppler  scale  factor  error  AsF,  Inertial  velocity  error  Avj  ,  Inertial  latitude  error  All  ,  platform 
misalignment  a  ,  and  gyro  drift  d  .  Tho  errors  arc  defined  as  the  Indicated  values  minus  the  true  values. 

A  diagram  of  tho  system  la  shown  In  figure  10.  Written  In  matrix  form,  the  differential  equations  for  thu  state 
variables  are 
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The  measurement  aquation  la 
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(4.8) 


The  F  and  H  astrlesa  are  given  In  Equation*  (4.5)  and  (4,6),  respectively,  The  matrices  U  and  N  are 
defined  by 

U  *  (€*) 

N,  0  0  0  O' 

0  0  0  0  0 

N  *  0  0  0  0  0  , 

0  0  O  0  0 

0  0  O  0  Nd 

where 

(nd(t>  nd<T>)  =  Nd$(t-r) 

<n,(t)  n ,<r))  a  Nf  S(t  -r)  . 


The  Initial  eatlaatee  for  th*  etat*  variable*  are  aeeumed  to  be  zero,  It  1*  aleo  uaumad  that  thar*  li  no 
Initial  oroii-correlatlon  between  state  variables,  Th*  Initial  oovarlanc*  aatrlx  (B)  Is  then  a  diagonal  matrix 
■ad*  up  of  th*  expeoted  mean-squared  value  of  each  of  the  variables  themselves,  since  the  Initial  estinata*  are 
aero.  With  nuabtrs  specified  for  all  the  constants  involved,  all  th*  information  la  now  available  to  define 
tb*  filter  uelng  Equation*  (3.3). 


Th*  rtaulte  for  th*  siaulated  operation  of  this  lystsn  ars  given  for  the  following  typical  values: 


initial  position  error 
Initial  velocity  error 
Initial  tut 
initial  gyro  drift 
initial  goal*  factor  wrror 
randoa-wslk  gyro  drift  (Nd) 
random  aoala  factor  (Na) 
uneorrslsted  velocity  error  (^U) 


=  0 
o  o 

=  0,3  win 

*  1.0  wsru 
=  0.3* 

*  (0. 1  asru)  '/hr 
3  (0,08*) ‘/hr 

3  0.8  knot. 
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It  1*  wamiuil  that  thu  vohlclu  accelerate*  to  500  knoti,  hold*  this  voloclty  for  ono  hour,  nccolorntos  to 
1200  knot*,  and  then  atop*  after  4  hour*.  Figure*  11-13  »ho*  the  position,  velocity,  mid  tilt  error*  In  the 
Inertial  ijitem  with  gwl  »lthout  the  filter.  figure*  14-15  »how  the  cntlmuto*  of  gyro  drift  and  *o*le  factor 
orror  that  arc  made  by  the  filter.  Figure*  10-20  »how  tho  expected  uncertainty  in  each  of  thu  state  variable*. 
Them  uncertainties  ire  given  by  the  aquure  root  of  the  dlegoml  element*  of  tho  oovarlanco  matrix.  It  cun  be 
eeen  that  there  Is  *  drop  In  moat  of  tho  unourtulntic*  at  ono  hour  when  tho  velocity  changed.  Tlio  change  In 
velocity  help*  the  filter  distinguish  between  Inertial  error*  and  Dopplor  error*,  buctuno  the  Doppler  error* 
depend  on  velocity  while  tho  lnertlil  error*  do  not. 


By  comparing  Equation*  (4.3)  and  (4.5).  tho  dynamic  equation*  for  the  Indirect  flltur  appear  very  elintlar  to 
thoae  for  tho  direct  filter,  In  the  first  element  of  the  etato  vector,  Doppler  scale  factor  replace*  vohlclo 
acceleration.  There  Is  one  additional  torn  whloh  give*  the  foodback  of  minallgnment  error  into  velocity  orror 
that  1*  due  to  the  cloning  of  tho  Schuler  loop.  Although  the  filter*  appear  similar,  they  have  vory  different 
characteristic*.  In  the  direct  filter,  the  system  1*  dominated  by  white  noiao  drivlnp  tho  acceleration  of  tho 
vehicle.  Tho  contribution  of  the  Inertial  erroru  to  the  measurement  1*  so  email  by  comparison  »*  to  bo  vory 
nearly  unobservable,  Also,  tho  sample  rate  for  tho  filter  must  be  very  high  to  accurately  follow  the  accelera¬ 
tions  of  tho  vehlcln,  On  the  other  hand,  the  measurement  In  tho  Indirect,  filter  is  made  up  entirely  of  nystem 
errors  -  either  inertial  or  Doppler.  Thu*  tho  filter  e.sn  very  effectively  identify  and  remove  navigation  errors 
end  ie  almoet  Independent  of  vehicle  motions.  Also,  the  ample  rote  only  has  to  bo  faHt  onough  to  keep  up  with 
the  slowly  changing  inertial  and  Doppler  errors,  finally,  since  tho  system  la  corrected  after  each  measurement, 
the  predicted  measurement  difference  ie  xero  and  there  1*  no  need  to  extrapolate  the  orror  state  variables. 


»,  APPLICATIONS,  CONSEQUENCES,  AND  PROBLEMS  OF  FILTERING 


Beside*  the  navigation  problem,  Kalman  filtering  alee  greatly  aids  tht  initial  alignment  and  calibration  of 
on  Inertial  lyitem.  A  flltur  of  the  itne  fora  an  that  used  for  navigation  can  bo  uied,  during  pra-fliglit,  to 
process  external  information  In  order  to  estimate  the  misalignments  and  miacalibration*  of  the  system,  The 
external  Information  may  be  just  the  faat  that  the  aircraft  la  not  moving  to  that  any  bias  velocity  is  velocity 
error,  The  atate  variable*  that  are  used  in  the  pre-flight  normally  include  platform  misalignment*,  gyro  drifts, 
and  any  other  terms  which  might  be  gubjeot  to  dsy-ta-dsy  variation*,  such  as  gyre  and  accelerometer  scale  factors. 
In  addition,  the  calibration  program  aliht  bo  run  with  the  platform  In  several  different  ettltudse  to  help  tht 
filter  eopirate  arror  source*, 


The  calibration  problom  and  the  navigation  problsm  are  to  similar  that  in  many  cases  the  game  computer  program 
oin  be  used.  It  li  necessary  to  lnnlud*  In  the  navigation  filter  matt  of  the  major  inertial  eygtea  error  eourcti, 
luah  u  misalignments  andjyro  drifts,  Thai*  parameters  are  the  same  onee  that  muet  be  estimated  during  the  pre- 
flight  calibration  program,  Thua,  with  only  quantitative  changes  In  soma  or  the  statistical  values  describing 
tha  system,  the  navigation  filter  will  alia  handle  the  calibration  problem.  For  example,  a  filter  which  ie 
designed  to  use  Doppler  radar  measurement!  con  be  uied  fur  calibration  by  making  the  Doppler  measurement  zero 
and  by  greatly  reducing  the  assumed  error  In  the  measurement. 


In  moat  oaoei,  filtering  technique!  will  both  improve  the  accuracy  of  tho  calibration  proose*  and  ehortsn 
tha  time  required.  A  filter  can  easily  handle  the  problem  of  .motion  during  tb'  alignment,  such  os  wind  buffeting, 
ind  oen  also  be  esahanlmed  to  account  far  th*  ohanglng  aharacterlatici  of  components  during  warm-up,  The  same 
type  of  flltar  can  be  used  to  transfer  alignment  from  s  master  syitem  to  souther  Inertial  system,  such  as  In 
aircraft  carrier  operations.  Alignment  and  calibration  are  considered  further  in  Section  7, 


filtering  techniques  are  also  useful  fur  poet- flight  analyses  of  navigation  lystems  during  a  tut  program. 

In  this  application,  all  necsesary  system  data  1*  recorded  during  night,  Along  with  ell  available  reference 
data.  The  refsrince  data  la  uied  in  the  sine  way  es  It  Is  used  In  flight;  but  reference  data  lg  uaually  much 
sore  accurate  and  th*  error  model  for  th*  navigation  ayitem  can  be  much  more  complete.  In  post- flight  analyses 
tvtn  better  use  at  the  information  oen  be  made  by  eitendlne  tho  filter  to  inolude  optimum  smoothing  techniques, 
whloh  mean*  that  referenae  data  are  uued  from  bath  sides  of  th*  point  in  question. 


One  of  th*  moat  Important  consequences  of  the  use  of  statistical  filtering  for  navigation  Is  that  it  changts 
-tha  basic  flgurt  of  asrlt  for  tht  compcnsnt  parts  of  ths  navigation  gyatsm,  Tht  dynamia  and  statlstloal  naturs 
of  ths  error  becomes  very  important,  In  addition  to  it*  absolute  aocuraoy,  What  Is  ultimately  Important  is  the 
total  tcouraay  of  ths  ovsrall  system  after  ths  mtasurimtnts  have  been  processed  by  th*  filter.  Thus,  whet  Is 
important  Is  th*  ability  of  th*  filter  to  detect  and  compensate  for  the  errors.  For  oxample,  If  a  component 
has  poor  dsy-to-day  stability  but  th«  error  ii  nearly  oonstant  one*  warmed-up,  the  total  system  toouraoy  might 
be  better  than  with  a  component  with  better  absolute  eceurasy  but  with  less  stability  during  th*  flight.  The 
parameteri  that  give  a  measure  of  this  lick  of  liability  during  flight  or*  the  nolea  inputs  to  the  error  equations. 
Them*  are  given  by  th*  N  and  U  nitric**  in  th*  filter  equation*  (see  Equations  (3,3)),  Thus,  on*  of  th* 
Important  parameters  of  a  oompomnt  li  th*  Hz*  of  thl*  nolle  term,  whloh  li  a  part  of  the  error  model  for  that 
component,  for  exinpls,  If  gyro  drift  can  truly  be  desorlbid  by  s  random-walk  model  ai  used  in  th*  exampli  In 
Oectlna  4,  then  an  important  figure,  nf  asrlt  for  a  gyro  1*  th*  increase  in  mean-equared  gyro  drift  per  unit  time. 
Th*  units  for  this  paranttir  would  b*  (aeru) '/hour.  Whan  a  filter  ie  used,  this  number  might  be  more  Important 
than  the  drift  rate  itself. 


An  even  sore  lmportint  consideration  la  tho  dynamic  aharaoterlatlcs  of  th*  errors.  If  t  filter  li  used  to 
ooabim  thi  Information  from  two  lyatems  whloh  have  error*  with  the  same  dynamic  characteristics,  then  the  filler 
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can  .do  llttlu  mars  th»n  produce  a  statistical  avuraflu  which  might  ruiluco  the  error  around  20  to  3DX.  On  tho 
other  hand,  It  tho  orrora  have  unique  dynamic  charaoteriatica,  then  the  filter  will  be  able  to  distinguish  the 
errora  and  obtain  a  posnlhle  70  to  BOJ  improvement.  da  waa  mentioned  in  tho  examples,  thil  rpault  in  gtlveJitnKcnuM 
when  an  Inertial  system  and  Doppler  radar  are  combined.  Moat  inertial  errors  are  related  to  some  Inertial  direc¬ 
tion  while  Doppler  errors  are  related  to  aircraft  uxsb,  Thus,  when  n  turn  is  made,  the  filter  le,  to  some  decree, 
ablo  to  distinguish  awl  calibrate  the  errors. 

A  vory  valuable  by-product  of  tho  uae  of  statistical  filtering  la  that  an  estimate  ia  available  at  all  tlmeu 
for  the  accuracy  of  the  navigation  system.  This  fonturo  has  at  least  three  possible  uses.  First,  tho  Informa¬ 
tion  could  bo  displayed  directly.  The  navigation  system  would  then  give  the  vehicle  oporntor  not  only  tho 
indicated  position  and  velocity,  but  the  estimated  accuracy  of  these  numbers.  In  some  situations  tilts  information 
oould  be  Invaluable.  Secondly,  a  rcoord  could  be  kopt  of  the  actnrl  and  estimated  orrur  in  the  system,  for 
example,  at  terminal  points,  tf  there  were,  on  an  average,  too  much  discrepancy  between  how  well  tho  syHtcm  was 
doing  and  how  wall  it  thought  it  wna  doing,  this  would  Indicate  that  tho  system  waa  not  operating  properly.  Tho 
problem  could  be  due  either  to  some  component  which  was  a'ceedinr.  specifications,  or  to  Improper  modeling  of  tho 
ayatem.  A  third  ase  of  this  statistical  data  would  be  the  automatic  editing  of  tho  input  data.  Tho  filter 
already  hus  an  estimate  n£  tho  expdetud  error  in  the  measurements.  Thus,  it  a  measurement  is  in  error  by  mere 
than  three  or  four  standard  deviations.  it  can  bo  automatically  rejected  anti  indication  can  be  given  to  the 
operator  that  something  might  be  wrong. 

Two  of  the  more  Importgnt  problems  in  the  uae  of  statistical  filtering  nro  tho  requirements  for  a  large  flight 
computer  and  tho  need  for  adequate  statistical  models  of  the  component  parts  of  the  system,  The  computational 
problem  Is  due  to  the  necessity  of  computing,  In  real  time,  the  optimum  atatletlcal  weighting  factora.  Tho 
weighting  factora  Involve  the  Integration  of  a  matrix  differential  aquation  for  tho  oovai lanca  matrix  (see 
Equations  (3.3)1,  This  matrix  hxa  dimensions  n  >  n  ,  where  n  is  tho  number  of  variables  bulng  estimated  by 
the  filter.  The  amount  of  computation  required  la  roughly  proportional  to  ns  ,  Thus,  the  more  complete  the 
model,  the  worae  the  computational  problem,  ror  a  particular  navigation  gystem  thsrs  will  be  a  trade-off  between 
accuracy  and  oomputor  capability,  For  any  system  there  will  be  a  point  beyond  which  a  larger  computer  glvee 
very  little  Improvement.  Considerable  knowledge  of  the  system  la  needed  to  actually  determine  the  accuracy/ 
computer- a l*o  trade-off.  This  fact  leads  Into  the  other  major  problem.  Some  possible  solutions  to  the  compute- 
tlon  problem  are  given  in  tho  next  section, 

Tha  other  major  problem  la  the  need  for  statistical  models  for  all  the  Instrument!  involved  in  the  navigation 
system.  Computer  simulations  of  typloal  navigation  problems  using  aupposedly  raallatlo  statistical  models  produoa 
outstanding  performance  when  Kalman  filtering  la  uaad.  But  tha  results  in  the  real  world  are  not  neoeaaarlly 
this  good  booause  of  unauepeoted  errors  with  which  the  filter  it  not  capabls  of  ooping.  A  detailed  statistical 
error  modal  for  an  Inertial  ayatem  has  not  really  bean  essential  In  the  past,  but  now  that  tha  modal  la  actually 
a  part  of  the  syetem.  Its  determination  la  much  more  Important.  To  be  confident  of  having  a  oomplete  modal,  It 
ia  neaesaary  to  teat  tha  system  In  an  operational  environment  aa  near  aa  posnlble  to  the  one  In  which  tha  ayntem 
la  actually  going  to  be  uend.  Ttiia  flight  teat  program  la  neoeaaary  to  aaaurs  that  the  atatletlcal  filter  can 
handle  any  peculiarity  In  the  aystem.  It  la  very  helpful  in  thla  flight  teat  program  to  record  all  Information 
that  la  nscessary  to  "re- fly"  the  flight  on  a  ground  bMed  computer.  With  this  reoordlng  It  In  possible  to  change 
the  filter  and  determine  what  the  results  would  have  been  without  having  to  re-fly  tha  aircraft.  It  is  thus 
possible  to  optimize-  the  filter  with  great  saving*  in  flight  teat  expanses. 


S,  METHOD!  FOR  REDUCING  COMPUTATION 

Tb*  first  method  for  reducing  the  oomputationnl  load  la  to  eliminate  alamenta  of  the  covarlenoe  matrix  that 
hava  a  negligible  contribution  to  the  operation  of  the  system.  The  linear  filter  given  by  Equations  (3,3)  give* 
tha  "aathsmstioal ly  optimum"  fUtar  for  the  model  that  was  assumed  to  represent  the  physical  system;  l.t.  terms 
are  lnoluded  even  if  they  would  reduce  the  aeen-squtrsd  uncertainty  only  In  the  ninth  or  tenth  elgnlfiosnt 
figure.  Ths  eesissed  statletUsl  model,  however,  represents  the  actual  eyttsm  to  no  more  than  two  or  three 
elgnlfioent  flguree.  The  problem  ie  to  Ionite  thoee  terms  thet  can  be  ellaineted  without  eignlfloantly  degrading 
the  performance. 

A  method  for  producing  tn  effsotlve  sub-optimum  filter,  whloh  ths  authors  have  used  with  some  auocsas.  la  to 
use  physical  insight  into  the  particular  problem  to  Identify  the  primary  flow  of  Information  in  the  optimum 
filter.  The  optimum  filter  le  then  separated  into  amaller  filtars  that  preierve  thla  primary  flow  of  information 
while  nsgleotlng  terms  whloh  have  negligible  offwet.  The  details  of  ths  design  of  the  sub-optimum  filter  are 
obtained  by  simulating  both  tho  optimum  and  sub-optimum  filtsra  for  ldentioai,  typical  problema.  The  design  of 

the  nub-optimum  filter  le  then  adjusted  so  that  its  perforates  matches  that  of  the  optimum  filter  as  nearly  as 

possible.  This  simulation  prooese  also  indicates  the  efficiency  of  the  sub-optimum  filter,  This  epproeoh  has 
been  relatively  eucceeeful,  particularly  for  almpllfylni  the  coeiputatlon  of  the  ooverience  aetrlx. 

The  eeoond  method  fur  simplifying  the  optimum  filter  Is  to  use  pre-oomputsd  gains.  If  the  filter  equation* 
are  euoh  that  the  gains  at  aach  nsMursment  are  only  function*  of  time  and  of  the  a  priori  asaumptlons  of  the 
atatlstloe  of  the  noises  tnd  ths  Initial,  stats,  then,  by  specifying  ths  aosaurement  schedule  or  rets,  the  gains 
aey  be  prt-oowputsd  and  etorod  In  the  vehicle's  computer.  For  a  small  number  of  measurements  this  Is  a  practical 
solution  to  the  problem  Involved  In  implementing  an  optimum  filter.  For  a  large  number  of  meseuremente,  the 
pre-coaputed  gains  are  usually  smoothly  varying  with  roipect  to  time  and  say  be  approximated  by  suitable  curves 

(straight  linos,  exponentials,  etc.)  that  give  almost  identicsl  filter  responses  is  the  true  gains.  Some  of 
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the  minor  galnn  may  ovon  be  neglected  completely.  Thin  tachfliquo  will  be  applied  tu  the 
end  alignment  of  uu  Inertial  platform  In  a  npaencrafl  on  tup  of  >  awnying  launch  vehicle 
to  the  technique  lined  In  the  Apollo  Ouidnnru  Navigation  and  Control  tynti'm.  ■ 


pro-lnunch  cnllbrntlun 
and  u,  in  fact,  similar 


7.  PIIK* LAUNCH  CALIBRATION  AMI  ALIdNMKNT 


7,1  Physical  Busin  for  Calibration  ami  Alignment 

The  Inertial  syHtem  to  be  callbratnd  mid  aligned  Includes  gyroscopes  and  accelerometers.  Tho  known  gravity 
acceleration  mngultudo  '«  used  to  ciillbrnto  the  accolernmutors;  the  known  Inortlal  rate  of  roUtlun  of  tho 
gravity  Vector  at  a  point  on  the  surface  of  tho  earth  Is  used  to  calibrate  tho  gyros.  In  thin  procedure,  the 
system  is  approximately  aligned  to  the  local  vertical  coordinates  (vortical,  south,  and  oust),  then  the  ityros 
are  used  to  instrument  an  Inortlal  coordinate  system.  The  two  approximately  horizontal  seed  promoter  outputs 
(south  and  cast!  are  usod  by  the  optimum  filter  tu  generate  cstimstus  of  the  system  mins' lgmncnt  with  respect 
to  tho  local  vortical  coordinates  and  of  tho  gyro  drifts  by  comparing  the  measurement  of  the  rotation  of  thu 
gravity  vector  with  thu  known  rotation  rate  In  the  Inert  In!  eoordlmuus  Instrumented  by  the  gyron.  Tim  vortical 
gyro  drift  Is  the  most  difficult  quantity  to  measure  since  tt  causes  only  a  third-order  effoct  on  the  muusurod 
acceleration,  flyro  failures  can  bo  closely  associated  with  changes  In  drift  due  to  acceleration  of  gravity 
along  the  input  axis,  so  the  pro-launch  calibration  of  a  gyro  In  a  vertical  position  Is  highly  desirable. 

Since  the  eatlmntas  of  the  alignment  and  drift  variables  will  depend  on  thu  mesnurament  by  the  aoceleromotora 
of  the  rotation  of  tho  gravity  vector  in  the  inortlal. coordinates  instrumented  by  the  gyros,  the  major  distur¬ 
bances  are  the  occolerometer  quantization  and  the  wind-induced  sway  of  the  launch  vehicle.  Tlio  model  of  thu 
system  for  the  optimum  filter  muet  Include  variables  due  to  tho  sway.  The  cumplete  filter  must  be  simulated  on 
a  digital  computer;  It  wilt  lie  linear,  ao  that  by  apeolfying  tho  measurement  schedule  the  optimum  gains  may  be 
pra-ooaputad.  The  gains  will  be  approximated  by  functions  that  will  be  storid  In  the  flight  computer.  TTie  method 
for  using  this  simplified  filter  In  other  platform  positions,  an  illustration  of  a  system  test  program,  and 
practical  hardware  problems  will  be  presented. 


7.2  Modi  la 


In  thia  lection  the  models  of  the  launch  vehicle  and  the  inertial  system  will  be  presented.  The  launch  vehicle 
bending  dynamics  in  tho  north-south  end  Best-west  directions  ere  approximated  by  identical  seannd-ordar  ayatems, 
The  wind  oauslng  the  vehicle  away  la  aiaumed  to  be  exponentially  correlated  with  u  correlation  time  of  l/\  sec. 

For  convenience  we  asaurau  the  wind  lii'oaoh  horloontal  direction  ia  unoorrclatod  with  the  other  direction,  an 
le  indicated  in  figure  21.  Ttie  correlation  funotlon  of  the  white  nolle  required  to  produce  the  predloted  value 
of  tht  missile  mean-squared  sway  oan  ba  found  to  be1’: 


nwS(t-T)  w  <n(t)n(r)l 


(p’XHq^K  t  8Xfrn  +  ^  S(t_T) 
X  + 


(7.  1) 


where  <p>)  is  the  prsdlctsd  main-squared  missile  sway,  n(t)  is  tbs  white  noise  generating  tho  exponentially 
correlated  wind,  and  uR  and  C  are  the  natural  frequency  and  diming  ralio  of  the  second-order  approximation 
to  the  bending  dynamics.  The  itate  victor  for  the  sway  variables  in  the  eouth  direction  la 
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are  ths  horizontal  displacement,  velocity  and  acceleration  in  the  north-fouth  direotlon. 


The  model  for  the  ewey  variables  in  the  eaet  direction  (pf  .  v( ,  a()  has 
Istions  to  follow,  they  have  ths  values:  <p*>  =  100  cm2  eaet  and  aouth, 
and  £  *  0. 1  . 


the  same  form.  For  ths  computer  elmu- 
K  -  0, 1  sec'  1  ,  a>D  =  S.09  rsd/sso  , 


Tbs  platform  orientation  with  respect  to  ths  local  vertical  coordinate  system  is  described  by  three  smell 
angles  a,  0  ,  and  y  .  If  the  platform  axes  (x  ,  y ,  z)  were  rotated  by  -a,  -0 ,  and  -y  ,  ths  axes  would 
coincide  with  the  local  vertical  coordinates  as  shown  in  figure  22.  The  state  veotor  equation  for  this  nub-state 
is  given  hy 
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which  has  been  turnwiJ  to  be.  for  entli-  e>oi!n t tuit««  of  Interest,  *  valid  representation  of  the  platform  dynamics. 

and  fiy  art’  the  horijontal  and  vortical  components  of  earth  rata  at  tho  tost  site;  il,  ,  dy  .  tly  arc  tho 
constant  drlfta  for  the  vortical,  south,  and  east  «yn»:  and  ty.  ty  ,  ty  are  tho  torquihg  rntcu  (If  any)  applied 
to  the  tyrnx.  It  ti.  sesimed  that  the  torqulng  ratca.  the  components  of  oarth  rate,  and  the  eunt  gyro  drift  arc 
known  perfectly,  so  that  the  vector  on  the  right  represent*  known  control  g(t)  and  Ih  independent  of  the  state 
of  the  ayatea. 

Paint  the  scall  angle  approximations,  tho  south  and  east  aeceleronutcr  pulHii  rate  outputs  duo  to  platform 
orientation  In  the  gravity  field  say  be  written  as 


sherc  pof  and  po  represent  the  total  pulse  counts  at  some  Instant  of  time,  and  g  la  the  local  gravity 
(cm/iec’).  A  I  em'sec  pulse  accoleronn-ter  quantization  has  been  sssumutl. 

Accolnroaoter  pulav>  rates  cannot  ho  inatuntonooualy  measured,  but  the  total  pulses,  which  rrnke  up  the  output 
duo  to  aety  velocity  and  orientation  In  the  gravity  field,  enn  be  counted.  The  filter  must  distinguish  between 
the  pulat  count  due  to  the  high  frequency  away  and  the  pulse  count  due  to  the  alow  rotation  of  tho  gravity  vector 
In  the  Inertial  coordinates  Instrumented  by  the  gyros.  Inherent  In  these  measurements  are  quantization  errors. 

The  measurement  vector  la 
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The  tan  “a,"  represents  the  quantiutlon  error  at  every  sampling  of  the  accelerometer  pulae  count  register*. 
Although  the  quantization  error  la  uniformly  distributed,  the  neasuraaent  noise  la  essumed  to  bo  gausslan  with 
zero  wean.  The  measurement*  are  aiade  once  a  second  with 

(n*)  =  ra  .  _  (7.6) 

The  state  vector  la  13-disrnalonal;  the  state  vector  differential  equation  Is 


d&/dt  -  Fj  +  £  +  £<t)  . 


(See  ngura  33  for  | ,  F  ,  £  ,  and  £  .  > 


11th  th*  derivation  of  tha  aodal  for  the  ayatam.  the  complete  optimum  linear  filter  la  defined.  The  accelero¬ 
meter  pulae  count  ruglstera  wilt  be  sampled  at  constant,  rates.  The  estimated  state  vector  Is  extrapolated 
between  measurement*  according  to 

i'  *  ♦  fi  .  (7.8) 


and  th*  covariance  matrix  according  to 


('  =  S 


where  4  and  8  are  pre-coaputed  conatant  metrical  for  th*  tlma  step  of  cne  second  between  aeasurements.  They 
aatlsf7  the  following  dlfferwntlal  equations: 

dS/dt  =  PO  +  SFt  4  N  8(0)  =  0  (7.10) 


d<t/dt  =  Tf  , 


♦(0)  =  I 


£ 


which  may'  b*  lntesrated  on  a  digital  computer  for  a  time  step  between  neasuremente  of  1  second.  At  the  time  of 
m  measurement,  j  and  C  are  chanted  according  to  Equations  (3.3)  and  H  .  U  .  and  N  are  given  In  Figure  23. 

7.3  Computer  Simulations 

A  complete  nonlinear  alaulatlon  of  the  Inertial  pier  form  In  a  swaying  launch  vehicle  was  made  on  a  digital 
computer  In  order  to  aiaulatm  real  accelerometer  output*.  The  initial  misalignments  were  1  degree  on  all  axes: 
drifts  ware  Id  oeru  tor  the  vertical  and  south  gyros  and  ttro  for  the  east  gyre.  (A  meru  la  approximately 
0.018  deg/hr, )  The  r.m.  a.  sway  In  each  horizontal  direction  was  10  ca.  The  Initial  conditions  for  the  covariance 
matrix  war*  1  deg*  for  tha  alignment  angles  and  100  a*ru:  for  tha  gyro  drifts.  The  sway  variable  variances  were 
100  cm*,  440  caVaec',  and  1900  cm’/aoc*  for  position,  velocity,  and  acceleration.  All  Initial  cross-correlation 
terms  were  assumed  zero.  The  Initial  estimate  of  the  state  was  a  zero  vector. 

Th*  rueponu  of  the  filter  eta  excellent  for  theie* condltlono.  A  cumber  of  runs  were  first  mode  In  which  the 
matrix  U  was  varied  so  as  to  cause  good  agreement  between  the  r.m. a.  error  as  determined  by  the  filter  and  the 
actual  error.  Tho  errors  between  the  estimates  and  the  actual  values  of  azimuth  angle,  vertical  gyro  drift  and 
south  gyro  drift  arc  shown  In  Figures  24-26.  Tha  errors  reach  email  values  for  the  three  cases  in  18,  40,  nnd 
to  alnutao  respectively,  hot*  that,  since  the  aeasurements  are  taken  every  second,  about  2400  samples  are 
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required  to  estimate  tho  drift  of  the  vortical  tyro.  Clearly,  any  significant  orrorn  In  the  model  for  thla 
ayatem  will  result  In  drastic  errors  In  the  vertical  drift  estimation.  The  errors  In  tho  estimates  of  the  t«o 
leveling  Angles  (a  and  /i)  are  negligible  ofter  the  first  few  measurements.  The  estimates  of  the  sway  vari¬ 
ables  sro  not  particularly  good,  since  we  are  sampling  once  per  eocond  and  tho  sway  period  Is  3  seconds.  These 
simulations  were  run  under  assumed  perfect  knowledge  of  east  gyro  drift  boesuse  of  the  classical  result  that 
east  gyro  drift  cannot  be  identified  from  azimuth  error.  The  fact  that  east  gyro  drift  must  be  known  proaonts 
no  problem;  as  seen  from  figure  26,  the  south  gyro  can  be  calibrated  in  about  10  minutes  and  the  error  shows 
little  sensitivity  to  d?  .  This  gyro  can  then  bo  placed  east  by  rotating  the  platform  and  a  oompleto  alignment 
and  calibration  made.  (Tho  Question  of  other  platform  positions  is  discussed  later.) 

7.4  Design  of  the  Simplified  System 

The  gains  Tor  tho  optimum  filter  may  bo  pro-computed  for  all  trials,  sinco  tho  measurement  times  will  bo  tho 
samo  and  the  a  priori  issumptlon  for  the  statistics  of  tho  Initial  state  vector  and  noises  will  not  change, 
for  the  problem  at  hand,  the  Implementation  of  the  gains  into  the  inertial  system  involved,  first,  tho  design 
of  a  nlmpllfied  optimum  filter.  Tho  gains  for  each  state  variable  estimate  depend  on  both  accelerometer  measure¬ 
ments  and,  in  general,  one  gain  Is  much  smaller  than  the  other  and  can  bo  neglected.  In  this  problem  all  cross- 
coupling  measurement  gnlna  are  neglected;  o.g.,  vertical  drift  estimation  depends  primarily  on  the  south 
accelerometer,  so  tho  east  tccslerometer  measurement  gain  for  vortical  drift  sstimstion  is  not  implemented. 
Typically  the  predominant  gains  vary  os  in  figure  27,  The  po,  gain  represents  the  number  used  to  multiply  the 
difference  in  the  measured  and  predicted  output  of  the  south  accelerometer  and  to  update  pc,  .  Thu  a  gain 
■ultipllea  the  lime  difference.  These  gains  can  be  approximated  by  exponentials  and  straight-line  segments  shera, 
at  dlatlmot  intervals,  the  time  constants  and  alapes  are  changod  to  continually  fit  the  approximate  gains  to 
the  true  gains.  The  gains  for  position,  velocity,  and  acceleration  quickly  reach  atoady-atata  valuers  and  may 
bt  approximated  by  three  constants, 

The  response  of  a  simplified  filter  la  shown  in  Plguras  24-26. .  The  proctss  of  design  snters,  since  It. 
rsqulred  s  number  of  runs  using  different  slopes  and  time  constants  for  the  gains  to  gst  a  good  matoh  with  the 
rssponst  of  the  complete  filter,  In  fact,  in  the  and,  the  same  exponential  gains  wore  used  for  both  po,  and 
po,  ,  and  the  same  exponential  gain  magnitude  wu  used  for  0  and  y  .  The  total  pre-computsd  constants  wars 
three  away  variable  gains,  two  initial  conditions  for  exponentials,  and  sets  of  the  following  five  numbers  which 
era  ohangsd  at  tan  discrete  times;  two  tine  constants  for  axponentlala  (po,  and  0)  and  three  alopaa  for 
strxlght-line  aetmente  (a,  Table  I  summarize!  these  comments, 

* 

TABLE  1 

Approximate  Osins 


Va rinblt 

Accthromittr  uttd 

form  of  approximate  gain 

P°, 

south 

axponentlal  segments 

po, 

•aat 

same  value  as  po,  gain 

V, 

south 

constant 

v# 

test 

iue  ii  v( 

1, 

south 

constant 

p. 

south 

constant 

ft* 

east 

seas  value  as  a. 

p, 

east 

•ana  value  as  p. 

a 

south 

itralght-lina  segments 

fi 

asst  , 

axponentlal  segments 

y 

south 

~0  lain 

■  dx* 

south 

straight-line  aegmenta 

dy 

east 

straight- line  segment!  v 

A  slight  variation  of  this  simplified  filter  wu  Implemented  in  the  Apollo  Outdance  Navigation  and  Control 
System.  Part  of  the  program  was  concerned  with  initialization  for  platform  positions  other  than  the  one  con¬ 
sidered  hers,  The  optimum  filter,  ones  isplsmsntsd,  doss  cot  change  for  other  plstfoim  positions;  ths  measure¬ 
ments  that  the  filter  gets  are  aids  to  simulate  the-  standard  platform  configuration.  For  sxssple,  If  ths 
platform  ages  wars  vertical,  north,  and  seat,  and  If  the  sign  of  ths  north  accelerometer  output  wars  changed 
to  simulate  a  south  accelerometer,  the  filter  output  for  the  variables  In  tha  south  direction  need  only  be 
Interpreted  ae  nagatlva  of  their  true  values. 
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Pbr  eomo  eppl Icatloni,  it  nay  be  daairablo  to  torque  the  aouth  gyro  at  negative  horizontal  earth  rate  to  korp 
the  east  atla  level,  The  fora  of  the  filter  and  the  filter  gain*  do  not  change  because  perfect  torquing  la 
Maimed;  Juet  add  negative  horizontal  earth  rate  to  the  eitrapolatlon  of  tho  angle  /I  ,  It  has  also  been  found 
convenient  to  uae  a  simple  flrat-order  egtrapolatlon  of  tho  alignment  angles  (ft  =  ft  r  a  dt  ,  etc.).  The  away 
varlablaa  arc  extrapolated  according  to  a  away  transition  matrix  whoao  eleaunta  can  bo  changed  to  compensate 
for  variatloni  in  parameters  between  different  launch  .vehicles. 

Once  the  optimum  filter  has  been  Implemented  according  to  the  almple  method  outlined,  it  can  be  readily 
adapted  to  varloua  probloma  of  alignment  and  calibration.  For  example,  cunelder  tho  following  eyetem  teat 
procedure  in  which  the  platform  axea  arc  identified  ea  x,  y  ,  a  : 

(1)  run  a  10-mln  teet  with  x  up,  y  aouth,  z  east  to  determine  y  gyro  bias  drift; 

(2)  at  10  min  read  out  y  drift  and  uaa  the  angle  estimates  to  allgh  the  platform  to  the  local  vertloal 
coordinates:  continue  to  hold  that  orientation  by  torquing  the  gyroa  at  negative  earth  rate  for  90  aeo 
while  counting  pulses  from  the  x  accoleroaeter; 

(3)  orient  the  platform  to  x  down,  y  east,  t  south  and  run  a  10-mln  teet  to  determine  z  bias  drift; 

(4)  uae  tho  angle  estimates  at  10  min  to  align  the  platform  and  then  torquo  for  90  sec  at  negative  enrth 
rate  while  oountlng  x  accelerometer  pulses; 

(5)  torque  the  south  gyro  with  the  negative  of  ths  horizontal  component  of  aarth  rata  for  45  min  while 
determining  vertical  drift  (x  gyro),  The  y  gyro  blaa,  as  determined  in  step  1,  la  d,  for  this  step. 

This  procedure  takes  about  08  minutes,  after  shlch  enough  information  it  available  to  determine  y  gyro  blaa 
drift,  a  gyro  bias,  the  aw  of  z  gyro  bias  and  acceleration- sensitive  drift,  and  s  aocalcrometsr  bias  and 
aeale  feotor,  One  can  readily  imagine  how  an  automated  aystaa  teat  procedure  can  be  sat  up  to  completely  cali¬ 
brate  the  system  in  the  swaying  spacecraft.  The  last  step  in  the  program  would  be  an  alignment  run  to  ready 
the  system  for  launch.  Through  all  of  this,  the  bulo  simplified  optimum  filter  doaa  not  ehanga. 

.7,8  Hardware  Problems 

The  primary  source  of  azimuth  error  la  the  uncertainty  in  calibration  of  the  seat  gyro  drift;  the  primary 
gouroa  of  vertical  drift  estimation  error  la  due  to  variations  in  the  east  gyro  drift  during  a  teat.  If  the 
east  gyro  has  a  large  drift  due  to  acceleration  along  its  input  axle,  then  it  is  dealrabit  to  kaep  the  input 
axis  almost  horizontal  to  minimize  the  variation  in  last  gyro  drift  by  torquing  the  south  gyro  at  nagatlva 
horimontal  earth  rata.  Unfortunately,  if  the  blaa  of  the  south  gyro  ohangea  when  It  la  torqued,  than  the  south 
gyro  calibration  will .yield  two  answers  corresponding  to  the  torqued  and  untorquad  casts  respectively.  (Torquing 
waa  dons  in  the  system  teat  program.)  Another  probltm  could  ocour  if  tha  accelerometer  biases  change  during  the 
calibration.  Figure  28  shows  the  affeat  of  an  exponentially  changing  east  accalaromatar  blaa  on  aouth  drift 
estimation. 

Another  possible  probltm  area  appears  whan  unlng  pulsed  integrating  aoceleroneters.  If  either  horizontal 
scoalsrosiatar  has  a  larga  drad-zono  for  near  zero  inputs,  large  transient!  in  tha  filter  output  will  rppear. 

The  form  of  tha  transients  will  vary  depending  on  tha  time  during  th*  teat  that  tha  accelerometer  goes  through 
tha  dead-zone.  Vertloal  drift  tat  mat  ion  is  particularly  sensitive  to  a  dead-zona  in  tha  aouth  accelerometer, 

In  some  cases  a  transient  on  the  order  of  800  meru  haa  bean  obaaived;  the  filter  never  reached  tha  correct  value 
of  drift  at  the  and  of  48  minutes  because  this  vertical  drift  gain  la  email  at  tha  and  of  tha  teat,  Aa  a 
practical  solution  to  the  problem,  the  platform  is  deliberately  offset  (between  steps  4  and  B  in  the  system 
teet  program)  from  the  vertloal  before  beslnning  a  vertical  drift  teat  ao  that  tha  accelerometer  never  goes 
through  null. 

Theta  probltma  era  indicative  of  ths  strange  raaulta  that  can  ocour  whan  tha  model  for  the  system  ia  incorrect. 
Philosophically,  wa  have  designed  a  total  system  teat  and  as  such  it  should  Indicate,  in  soma  manner,  out-of- 
apeclflcatlon  conditions  which  would  than  require  lower  level  tasting.  The  model  must  therefore  include  all 
ln-apaolflcatlon  conditions  and  tha  designer’ a  sxperianoe  must  be  used  to  reoogniza  out-of-speclflcatlon 
situations.  J 

7.7  Laboratory  Teat  Results 

A  significant  portion  of  tha  filter  design  was  done  in  the  laboratory,  since  digital  simulation  can  never 
equal  actual  hardware  tasting  in  pointing  out  tha  important  problem  arses.  As  part  of  tha  filter  implementation 
verification,  the  Apollo  inertial  platform  waa  suspended  hy  a  cable  from  tha  laboratory  ceiling.  The  platform 
waa  pushed  to  simulate  spacecraft  motion  on  the  launch  pad.  Comparisons  with  independent  measurement  techniques 
verified  tha  program  accuracy  to  within  the  lialta  of  the  gyro  peifuraanoe. 


8.  CONCLUSIONS 

Navigation  syatwaa  are  on#  of  tha  aoat  important  applications  of  Kalman  filtsrini.  Conversely,  Kalman  filter- 
lag  la  one  of  tha  aoat  important  new  developments  Id  navigation  ayatems.  It  la  likely  that  most  future  navigation 
systems  will  involve  Kalman  filtering  in  some  form.  However,  considerable  engineering  experience  le  required 
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to  develop  in  effective  filter,  because  the  physical  systems  are  never  precisely  defined  tho  neooeeary 
itatUtlcal  sodels  aro  not  veil  known,  and  the  computer  la  never  term  enough,  U  la  hoped  the  dlucuwilons  In 
thia  chapter  can  be  of  some  help  In  obtaining  the  undemanding  nocosaary  to  deveinp  efficient  navigation  flltere. 

In  simmary,  we  night  auggoet  eight  atepa  for  tha  successful  Implementation  of  a  filter,  auch  as  tea  llluatratnd 
here; 

1.  Develop  nodela. 

2.  Digitally  simulate  modal  and  filter  equations, 

3.  Doalgn  simplified  filter: 

(a)  restrict  model, 

(b)  decouple  variables, 

(o)  approximate  gain*. 

4.  Digital  alnulitlon  of  system  and  simplified  filter. 

5.  Implementation  Into  guidance  computer, 

6.  Checkout, 

7.  Teet  experience. 

8.  Recycle  to  step  1, 

The  requirement  to  simulate  the  complete  system  with  tha  filter  aquttloni  has  been  inserted  to  demonstrate  the 
filter's  ability  to  eatlmate  tho  quantities  of  Interest,  It  has  boen  all-too-coamon  preotloe  to  simply  run  the 
filter  equations  tnd  look  only  at  tha  propagation  of  ths  oovarlanoe  matrix.  Finally,  as  prsatleal  experience 
Indicate*  modeling  errors,  tho  sources  lust  bs  found  and  practical  solutions  implamantad. 
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N4VII4TI0N  dYITCf I 

J.ft.Huddl* 


I.  INTtlMICTION  .  . 

la  U<  pMt  too  decsdM  different  oivlpstlon  «j»ori  hs/e  ban  combined  «Uh  in  luartlel  plat  fora  to  obtlla 
Mariana  aultl-ienier  vittu  for  perforate.  th#  r,»*l|»tiao  function.  The  olio  objuetl/e  In  Ut*ir*tlp|  union 
Uto  ■  ojritofc  hto  been  to  In'tMii  the  niviietlonil  tcc.rvcy  obtilnsbl#  ohtn  inforaetiou  fraa  Independent  aenaori 
if  properly  ailed.  Anum-T  objective  feu  bon  to  Inortuo  tho  probability  nf  euccess  of  •„  *i*#n  oloilon  ‘.hit 
oau  bo  fcfelOTtd  tnrouah  tfe*  eiiitenc#  of  independent  wllur*  oodot  io  i  syutea.  These  oodoo  art  milted  bjr 
different  eoablnatloo*  of  Mitort,  each  capable  of  provtdiaa  uttful  infcastlon  durln*  o  oiooloo.  fioductloo  lb 
total  ayitw  coat  ud  •  -iifet  cu.  alao  mult  In  eueh  dveicns  boioa  obtiimd  loplteitlj  through  f  reluatloc  lo 
laaivtdaal  manor  perforaaac*  reqaireaenti.  tbo  reduction  in  ainaor  rjqulreaent*  lo  aultl>**naor  sv.'teaa  usually 
mom  a  dociom  in  design  coapleiity  »ith  iMeddia*  roductloea  la  Motor  til*,  aaiafet  and  coat,  laerauod  ralli-  '■ 
blUV  *ad  alaptar  aautenaas*. 

(afnra  tin  developaeat  of  lalaao  filtsrlng  thasry,  it  *u  roallaad  io  tha  oavigatioa  flold  that  latairatad 
apatea  op* ration  offarad  tfe#  opportunities  already  outllatd  for  obtaining  iaproved  navigation  aystaa  efearaotar* 
intlt IIOM«ir.  tka  uulytli  and  opt  la  lull  on  u  /  tha  trror  behavior  la  thaaa  lystea*  la  a  eoaptaa  taak,  alaca 
tfta  aadola  daaerlbiaa  theaa  arroti  aia  atoebaatle,  tiaa-variut  ud  bava  high  dlatnflco.  The  deairaa  for  tfe* 
ooatrol  of  trror  in  nolti>a«gaor  ur*taaa  vara  obtalaad  uinly  by  Mint  tka  elaaaleal  freqoeocy  Conic  ud  root 
lanaa  tockatoava  coordinated  with  trial  ud  error  deaiia  oiperlntaution  on  unloi  or  dlalUl  mputore.  The 
Ida  eat  of  tha  lalau  theory  ud  tha  availability  of  noro  aopkiatleatod  dicital  uonpvtlaa  hnrdanro  tad  tofteare 
far  la*Mt  tint  lac  eoaplei  ayataa  *r-jr  behavior  hat  rave lut too tied  tha  dealin  of  th*  trror  control  aochuiaa  for 
neat'  Mltl-aanier  aiviaatl  m  api‘.e~  .pplieatlcna.  The  lape'.ua  fnr  thla  chain*  multi  fraa  tha  aiiateaet  of  tha 
laaa.'  aqaarwa  cootrolle-  aolativ  for  linear,  itochtatic  lystraa,  a*  provided  bv  Kalaaa.  and  iba  atone  hr  »hich 
datet.ad  behavior  of  caaploa  aya'.ean  can  ha  iiulned,  u  provided  through  the  u*e  of  Mih  apeed,  Urge  capacity 
duiul  naaputara.  Tka  aitalflCMc*  of  theft  polnta  for  practical  dellru  problems  alii  becoao  aore  evidart  later. 

Tkla  chapter  bealaa  hr  dateriblac  tha  MVlaat'oe  function  ud  tka  rtqulreernta  ehleh  art  caoallr  lapoaad  oa 
UelaeMoa  aratana.  Tha  aajor  cluaiftMtlona  aithip  ekiek  Boat  navigation  5tn«o.a  cu  l«  grouped  are  defined, 
to  fllaatnta  bo*  tbeoa  different  navigation  aenaara  bava  ban  employed  la  convent  tonal  deoltna,  tha  thaorr  of 
ape ratio*  of  three  fundamental  unvoted  inertial  nivlgiHon  iyvte*i  ia  presented,  aim  thl*  discussion,  n 
parapactlvt  la  obtainad  for  conaidvrlat  a  kalaan  o->ehat,lu>ioa  for  these  s/stvas  in  a  liter  aeotlcn. 

•lata  tha  caaputationa'  alloratlca  for  error  control  lit  an  actual  ustea  1*  Halted,  coaatralnta  auat  M 
lapoaad  an  tho  coapUtlty  ud  ccnfliu ration  of  a nr  Ralata  deiign  propoud.  bone  of  tha  praelloal  problra*  af.eet- 
lH  tha  eoafliuratino  of  the  error  controller  in  aetual  ayatVM  tie  dlacussed.  nod  the  bulc  op#rntiona  »hlch  are 
tapleeeated  la  aultl-atnacr  navigation  systeo  ippUretion*  ire  defined.  Th*  question  of  the  unplsilty  of  th* 
fatau  daelin  la  alio  considered,  end  a  procedure  ehleh  ha*  been  used  in  error  controller  vntheala  l(  described. 
Thla  denial  appracch  in  then  used  to  obtsln  a  Kslaan  error  control  atchuivttion  ehleh  la  nuUrhlp  for  applying 
taefe  of  th*  tlirt*  auuented  loartlel  navliatlon  ayaiaa*  pr*rio,islj  eiutoed  to  a  particular  arataa  Billion. 

I 

The  chapter  concludes  hr  illuitratlna  (he  ayitea  perforaaoee  fnr  this  elision,  se  ob'ilned  e|th  the  derived 
tolaaa  ■achaclutlon,  and  dlacuuLoi  the  inlqu*  futures  of  th*  threa  navigation  systea*. 

.  ..  ■■  v.'.  i.  •  .*• 

I.  N4VIC4TION  4ND  U.  IlhSOPi  IBPIOTCP  IN  h4Vi84TIOT  ITSUBS 
1. 1  (eaaral 


Th*  fuaatlna  of  a  navteatloa  arstea  la  to  ds^rnln#  the  petition  of  t  rehicl*  euch  that  It  cu  Da  diract 
U  other  position*  defined  *n  th#  selected  frsa#  of  reference.  Terreerrlt)  neviistlon  Is  ueuallr  perforaed  vith 
reapect  to  in  orthoeonsl  csordlnats  sr*t*e  afflitd  to  tha  enrth  s.ileh  his  one  ills  coincident  elth  th*  terrestrlsl 
polo  ud.tvo  till  in  the  equntorml  plan*.  Vehicle  ponltion  in  this  friae  of  reference  Is  denoted  In  tens*  of  th# 
tau  »c ruler  nenurtr  of  latitude  and  loniltud*  end  the  linetr  eetxurt  of  sltltude.  4«  seen  in  Firur*  1.  loniltud* 
la  Muarad  aaatenrd  or  aeataard  about  th#  polar  sirs  trim  the  sero  innrit'idi.isl  »*riciin  shlch  passes  through 
8fab**ieii,  Enalsnd.  Latltuda  i  is  neasnred  north  or  south  tram  the  equstoriil  plan*  shout  in  ilia  orthotonal 
t#  poftdlooal  plin*  in  *hlek  the  vehicle  lit*.  Altitude  b  ia  pMturad  positively  or  naaitlvalr  with  respect 
t*  oa*  level  aloof  tha  local  ve-*.lcsl  at  the  la 1 1  tudo  and  loniltud#  of  th*  venicle. 
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U  bMltlcm  to  vehicle  positive,  the  navigation  vitM  U  often  required  to  provide  velocity  of  the  vehicle 
altb  mint  to  the  oortti.  The  tapomli  of  tha  valoeity  vector  ui  usually  dasired  along  Ui  orthogonal  un 
of  o  ooordiootj  qntw  located  »>  tba  vehicle  pooltica.  Tbla  reftiemea  ti  celled  tb«  local  geographic  aoerdtaate 
ayatu  cad  boo  era  aiia  coinoiocot  oith  tbs  local  vertical  tod  tao  ure  U  tbo  l.cal  level  or  horiiom  plus, 
aao  bleu  tbo  local  north  Hoc  ud  the  other  dlractcd  aaotaard, 

Another  typo  gf  data  oftti  required  rrao  i  navigation  eyetu  la  vehicle  attitude  *itb  raapoet  to  the  local 
aariiaa  plane  and  aortb  lloa.  ta  lophUtleetov  avluotci  arataaa,  a'tltudo  lnforaatloa  lc  required  to  accoopliah 
aatcaotlo  aircraft  guidance  bad  control  for  caapaa  delivery,  cru.aa  t>  pre-eeltcted  deet  melius,  aad  landing 
cad  take-off.  Attitude  iafonaetloa  la  available  ebao  tbo  oavttatloa  ayatew  incorporates  o  otabliirad  rarorooco 
cock  to  ta  liartlal  platform, 

To  ootlofy  MM  or  all  of  the  aavita'lcc  aratao  reqq;r‘»onte  olacuaacd,  different  types  of  aanaora  era  eeplorod. 
Hoot  of  tbcao  aarlcatloB  aeoeora  caa  m  placed  la  ore  of  three  catntorlea  tr.aad  on  the  tjpeo  of  data  that  t*ity 
provide,  Tbcoo  three  claaaaa  encoapaaa  aarlialloo  aanaora  which  pruvlde  inertial,  apor-l,  or  (Alltloii  Information 
la  moo  fora,  leae  of  thaac  aanaora  (a.i..  inert  til,  LORAN)  are  capable  of  achieving  ecaao  or  ell  of  the  aevlga- 
tloo  ayetam  rocuiraoaata  ertanomoueU  Where  (o.f.,  Doup'ei  radar,  ranee  aaeeurlni  cuuloaental  require  Informs- 
tleo  from  ether  oaettatira  i*oaora,  prlmartl.  an  Inertial  platform  to  acoepllah  the  naeliatloo  function,  tech 
of  tho  throe  elaaal float  Iona  to  non  daoeribed  to  ijtroauca  vniulns  notorial  on  tba  prlnclplao  of  operation  or 
idea  baale  oasMotcd  Inertial  navigation  ayaiane, 

l.l  laartlal  (cmaort 

Tba  baa  10  element  of  bit  Inertial  aanaor  la  the  platfore  The  platform  consists  of  a  mechanical  structure  on 
thlah  tho  inertial  laetnjaanti  art  aountad.  t;  to  thrae  accalaroMtarr  are  incorporated  in  the  platform  lor 
momauriad  orthoaonal  (pacific  force  aagsitudes.  Qyrnacopae  are  ineor^  rated  tor  the  attitude  ncaauianant  or 
itabOtaatlo*  of  tba  aocalaromatar  triad  ti  a  apeelftad  orientation. 

Vita  bacnlodia  of  tho  local  aaa* -at  tract  I  cm  rector,  an  Inertial  Miuor  c-n  be  ucod  to  determine  the  rector 
aecclarmtloa  af  tba  carryim-rcblclc  tub  rcopect  to  the  inertial  apace,  «nca  tbla  Informatien  la  provided  to 
•  dompatar,  Mbcoauant  lntairatlooa  cab  be  performed  to  field  vehicle  velocity  and  poem  on.  lo  addition  to  tbla 
baolc  notability  to  provide  aufftclaal  lu format inn  far  autonenoua  navigation,  inertial  aanaore  art  uaad  u 
attitude  rafaraaeca  providing  tba  aaiular  oi  lactation  of  the  vehicle  altb  rrapaot  to  the  local  horlaoo  plane 
and  aorta  11m.  Tble  attitude  data  la  aacd  la  tbo  operation  of  otbor  noeliat.cn  aanaore,  a a  all!  ha  eaen. 


Tboao  aanaora  cut  proeldt  apaad  of  tha  earning-vehicle  along  different  ulrtcMoni.  The  Interpretation  of  tbla 
information  aa  a  vector,  bewovar,  raquliaa  tba  tree  cf  aa  attitude  rafertnea  i;itae.  Too  type*  of  apoad  conpcnant 
Maturing  Instrument!  sitst,  The  firat  type  datcimlnca  apetd  aith  re erect  to  tie  teulua  la  thlch  tho  vehicle 
travclai  u  achieved  by  air-apeed  Indicator!  or  ahlpa'  .oua.  fbe  aecond  type  -splays  tha  Doppler  frequency  ahlft 
IbMCMTdb  (high  la  aggnpUflod  la  Doppler  penar  er  radar,  Tbaaa  Doppler  I'.etruaenta  provide  apeed  altb  raapact 
ta  a  ra  flea  ting  air  face,  ueually  the  earth’*  aurfaea.  The  attitude  data  provided  to  aubillu  tbla  information 
aa*  yield  velocity  component!  along  tha  Uul  (aograpbic  coordinate  aao  a,  Subaequeot  lntogratloo  of  tbo  velocity 
oompomcat  data  la  a  ceaputcr  can  >.eld  tha  preaent  latitude,  longitude  and  aUitudo  of  tho  vthlclo. 

1,4  taoltlob  or  Aapilar  Wo  core 


A  omabor  af  ulaai'fieatloo*  euat  for  aoMoro  ahluh  provlda  lotoraatloo  uaarul  <n  daiarmlclng  poult  loo.  One 
typo  Ipoludoo  tracking  eyeteae.aucb  aa  eatro-tracktrs  and  ontlcal  alchta,  which  provide  the  angular  orientation 
of  a  point  of  knoeo  Inertial  or  geographic  location  oltb  raapact  to  a  eat  of  coordinate  aiaa  of  knoan  orientation 
la  tha  vablcla,  Tbla  type  rf  aanaor  raqulraa  aa  ettttroe  raference  utd  computer  tg  obtain  uaaful  navliatl'n  data, 

Aootbar  bae’e  eluelflvatUn  for  rvxltlon  eensora  inoludee  thoaa  abieh  aia  baaed  on  tlalni  •ecbanlaaa, 

Included  are  arataaa  ehleh  naaaura: 

(a)  Ttaa  batmaao  tha  treauiualoo  too  receipt  nf  a  pulee  st  anergy  iron  objects  of  known  location.  Tbla  lc 
4cm  altb  ranging  radar,  laser  range- flndcra  and  diatanre  o town ring  equipaenta. 

(b)  Dlffcrmcc  between  tlaa  of  arrival  cf  pulaer  fron  different  tranaolttarc  with  knoan  location.  Thla  ta 
tama  with  aalitlni  LCAAH,  ud  M|i  ud  propooed  aatall.'ta  pavigatioa  eyetene. 

(e)  Iitagretod  Doppler  ahlft  data  to  provide  tba  chuia  In  ruga  to  t  rafleotug  or  truulttlnr  target. 

To  obtain  pneUien  In  theca  vratama,  huh  fraquanclaa  era  amployad.  Hultlpla  frtquanclta  cm  te  uaad  to 
raoelvc  aabinltlas.  In  ayotana,  tbaaa  eoooora  art  usually  eaployad  with  other  types  of  navigation  sensor*  ud 
a  digital  computer,  ■  1th  aa  Inertial  sensor,  tor  itaapla,  deed-reckoning  of  vehicle  position  caj  be  perforaed 
bet»a »«  tba  tlaaa  at  wblch  position  information  ta  available,  wttn  tha  advantage  that  navigation  data  la  available 
continuously. 

Angular  lafonatiw  eu  be  provided  altb  radio  equicaent  having  directional  rrdiation  characteristics 
Bump  lam  af  aoeb  aqulpMnt  are  found  in  laatrumut  landing  .  yeteaa  at  airports,  thick  provide  glidt-alopc  ud 


Reproduced  Irom 

,ol  available  copy. 


tie’  J  «  .  A  oWJ  A  1 


8SS®!H@SBSff3W! 


238 


bearing  «uU  iwlliitlai  to  MIM  elraraft.  Another  niatli  t*  provldo.  by  unitary  TACAft  ted  civilian  snot* 
nagf  lUtlw,  tilth  prtt'dt  ltd  lent  lot*  of  vthlM*  beer  in*  tlth  rttptet  to  tht  rvaptet  »»  tianantttar*.  Tht 
ottt  a  am*  rvhial#  httdltf  itdlettor  available  it  tht  **#r.»tic  conpaaa,  ttleh  provide*  DatJiaa  toforpotlee 
rtlotln  t«  tht  aegaetie  point  of  tit  ttrU. 


>.  CMVINTfPNAl  At Oh th Tib  INtBTIAl  NAVIGATION  lllllll 


Thin  •  tot  loo  rtf  loot  tie  uoetr  It  thlch  dlffirtnt  itntnrt  have  b*vn  tool  of  td  it  oo  rt  eoartatlcnal  auvantid 
lotrtiel  aoflioMea  ayatena.  Tht  dlacu talon  till  ptrolt  a  batter  uaderatandlna  ni  tht  advutagea  itlntd  through 
tht  tot  of  gyitan  trror  cceitro'.vre  btttd  on  Uloto  theory,  vtiieb  era  diioutttd  totor .  To  prorldt  tail  Intro* 
duet lea,  tht  thaeiy  of  oparat.’oa  for  thrtt  augaaniad  inert t ol  niriiitinn  tyittoi  it  dlaeuaatd.  Tbt  thru* 
oariiattoo  ayatuaa  that  ban  Pont  Kite  tod  irt  cooooolr  referred  to  it  Ooppltr*lnortltl,  LOtVMoertlal  ud 
aatre*irtrtlil. 

Ao  laartlal  ttator  hor  bttt  taltettd  for  aaeh  of  the*#  eye  tea*  oloot,  In  implication*  of  *"y  soop  *iltjr,  tht 
ott  loot  loo  ay  a  tea  till  Inolodt  to  lotrtiol  aenror,  rail  occur*  bvioutt  tht  Inertial  **naor  prorldt*  tht  ooat 
dyottlt  for*  of  lnforaatien  pcaalbU  throuah  o  dlrict  atamrewnt  of  icctlMition  tnd  attitude  ofttn  otceaaary 
for  tat  operatic**  of  othrr  nav.gitloa  ttntor*.  Tht  thrtt  nirltition  ayateia  atlietid  illuatratt  dlatluct  ott hod* 
tf  tyata*  optratldo  throuah  tht  charoettr  of  tht  atntor  'iu»e-iing  tht  lntrtlal  aemor,  in  »*eh  of  tht  ayitaaa, 
o  taopittr  ouat  bt  aiauotd  to  ptrfoni  tht  rtoulrtd  proetaela*  of  otuurtotat  diti  to  obtai*  tht  aarlftttoo 
varlcblt  output*.  Ilnct  tht  iotrtial  itnior  plat*  a  biale  roM  la  t*ch  eyit**,  t  *  theory  of  It*  autoooooua 
aparatioa  olll  bt  ditnitetod  ;ir*t. 


M  htaWM  laartlal  Navigatiaa  lr**oi  Optrtlito 

■tfstt  m  iatrtlol  plitfo'a  eat  arotldt  output*  uitful  for  Mflaittoo,  tbt  eecelerotvter  tit*  ooat  bt  atdt 
MMliet  with  tht  orientation  ittaotd  la  th*  navigation  *auputvr.  In  ao*t  tarraatrl‘1  navigation  application* 

■  Ighaltr-tuaad  nlat for*  1*  toplaytd.  In  such  an  Inartial  aratn,  too  orthogonal  acoalarowtor*  ara  initially 
allpsad  aod  thoa  aalatMaad  in  th*  loeal*ltrtl  pinna.  A  third  orthoaonal  *ee*l»roo*t*r,  if  aood,  *111  thta  ho 
totooldaot  with  th*  local  gratify  ro*t«f,  Th*  aalntmino*  of  tar  fUtd  plat  for*  crltatatlur  with  rtapret  to 
lh*  forth  ratal rag  rot »t loo  of  tht  plttfora  tlth  rttptet  to  Inertial  (pact  to  ecaptiuttt  far  tht  rotation  of  tht 
nan*  title  rttptet  to  Intrtul  tptna  and  any  rtlatlvt  ingular  rat*  of  chan**  of  tht  i*ogr*|ilo  rot  It  lee  of  tht 
MnylM***iltlt.  Tht  aalotth  tf  tht  platfora  it  oaflntd  u  tht  tegular  rotatloa  la  tbt  Itrtl  piano  of  ant  of 
th*  lotal  tmltroaattra  fro*  tht  local  north  Una,  •*  will  aatunt  that  an*  of  th*  lot* I  aectlercneteri  la 
olnaya  poantad  aorthtord,  raaultiag  In  that  la  hnotn  a*  th*  aorth-vUvei  pin  fora  tvchauliitloa. 

•wo  th*  plctforn  1*  alltatd,  th*  *ce*l*roo«t*r  orientation  aaauaad  la  th*  natiiatlon  c/*put*r  allota  th* 
aotaal  aptclfle  fore*  **»**•  t#*a*i  to  b*  prootaaed  to  yield  uatful  nevlgat.un  intonation.  »or  tvrreitrlal 
nevlgntl. tahiola  raloelty  and  poaltleo  tlth  raaptU  to  tha  coordinate  fru*  armed  to  th*  aorth  1*  required. 
To  derive  thla  mroraaiion  frm  tha  aecalarooatar  input*.  aectliratina  tlth  r**p*ct  to  lntrtlal  anec*  la  flrat, 
ofctolid  by  aaht noting  th*  tffout  of  hnotn  local  gratify  fro*  th*  apaclftc  fore*  Muurwwti.  Th*  derivative 
tf  rthlclp  tilotlty  tlth  rtiptet  to  tli*  tarth,  t*k*n  tlth  r**ptet  to  tha  *rc*l*ro*»t*r  coordinate  irataa/  It  than 
ohttlatd  by  moving  eoaputtd  Corlolle  aeealaratlon  eoaponenta  fro*  that*  InortUl  accelaritioa*.  Tht  CorloM* 
tteel  trail  a*  eoarmtat*  art  daptiHant  on  tht  vtleelty  and  rotatloa  rite  of  tht  aeceleronattr  triad  tlth  rttptet 
to  th*  ttiAh  aad  tht  rotatloa  rata  of  tht  earth  »lth  rttptet  to  iecrtial  aptet.  Tht  retulting  thrtt  darlvativau 
art 
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(■n.a.glp  are  iptctfle  force  aggiitudta  aauured  by  the  taec,  north  tad  vertleal  ocelvroovteri, 

rtapactlvaly; 

(Vg.a.l>*  »ra  eoapatad  c onpootata  of  tthiela  velocity  rltl  rttptet  to  tht  terth  along  th*  local  latt, 
aorth  tnd  vertical  geographic  •*•*,  reaptetiraly; 

Ir'g.i.glf  art  tht  laitanttneout  eotputed  uc*pontnti  of  angular  rat?  of  th*  local  taographle  ait*  tlth 
raapeet  to  tht  tarth  about  tha  taat,  north  and  vertical  aaaa,  dje  to  rabicll  raloelty  eltb 
rupee t  to  th*  tarth; 

<*fa,g>*  »re  the  conpatr'  eonpoeaati  cf  th*  angulai  rati  of  th*  earth  tlth  re  aptet  to  lnortlal  apoe* 
about  the  local  aorth  and  vartleal  an*  (note  \  *  0); 
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Tb*  br*oh*t*d  Urs*  oa  tt*  M«bt  tide  •(  Ctuctir**  (1.1)  »r*  tb*  Cor loll*  MatUratlea  oaptiHU,  l*t*pr*> 
tUn  if  Um  firlntlfft,  »hleh  in  with  r*cp*ot  to  M*  local  a*o*r»pblc  eoordlo»t*  *r*t*u.  jrt*ld*  th*  «o*p*t*d 
nlw  of  vahlol*  velocity  *tth  nifttt  U  tti  **rth  iiiiiim4  la  loo*  l  4*o*r»phtc  worduhtv*. 

The  ampvtad  imMiti  of  riUtln  mtlir  rat*  of  th*  local  Moaraphlo  uirtiiitu  thta  added  .a  Mputa* 
local  *arth>rat*  «oaaaa*at*  in  **ptep«d  to  rout*  th*  irro*  la  loirtltl  ip*e*  to  r&iataln  la*  loeil-ltvil, 
aarth  •elated  orltaUtloa  of  th*  put  for*.  Tb*  rittll**  r*t*t  *r*  obuiovd  fro*  thr  cojputrl  velocity  oeaponmt* 

a* 

* 

^i*  *  “^»i^***  > 

*  f>u  •  *»«*.  •  <>•*> 

^t*  *  All  lM  *8  • 

n*n  «*,  ,t  th*  toaptMd  atrldloaal  radlu*  of  th*  ••Mb  and  N,  la  tb*  ooputtd  norwl  radio*  of  th*  **rth. 
Th*  oaapuwd  local  «arth  rat*  coat  .tort*  ar«  obtntnid  br  projietta*  th*  *artb  rau  about  tb*  pol*  eato  *h*  local 
a*rth  m4  vortical  *■•«: 

*  ()  «»•  *8 
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Th*  niputrf  *n*u..»r  r»t*  of  chut*  vf  th*  pl*tiora  crUatitloo  *lth  reapvot  to  toartlal  *p*c*  la  tb*a 
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%*  actual  aacalar  rat*  of  r'titlaa  at  tb*  r  lit  for*  *tth  r*ip*ot  to  lurtUl  *poo*  difftra  fro*  lout!-** 

I*  a  *t**h**tl*  fanotioa  8u«  I*  *rr*r*  la  tb*  platfor*  pro*: 

•W  •  ♦  *1  . 

S*  *  “fc*  ♦  bi  •  >  (U) 

Sp  •  ♦  ►. , 

•tor* 

t*  th*  ca*rit*d  aaaaUr  rat*  of  ohao**  of  th*  platfor*  *lth  rcip*ct  to  loartial  *p*c*  *tpr*aa*d 
about  th*  loetl  towrtphl*  **••! 

<'%*.*>p  ‘f  th*  lo.ual  aneular  rit*  of  chani*  of  th*  platfor*  *ltb  r«*p*ct  to  ln*rt 1*1  *p*o*  *ipr****d 
rbout  th*  locil  *«o(raphlo  tat*; 

(h||lt|)  ar*  *toah**tt*  fusctloer,  r*prt*«ntU|  liurillivd  (pro  drift  rrt*  »' th  r**p*ct  to  lotrtlal  opao* 
aapr«a**d  a  boot  tb*  local  a*o*raphlc  aua, 

Th*  flail  at*p  lr  dat*r*lnln*  th*  oavtiatlon  vtrUblit  l«  th*  coupvtitlan  of  vetitcl*  porltlan  la  tho  atrth 
coord loetl  treat.  latitude  uu  iceillud*  or*  craputod  u  li.tiinl*  of  th*  local  r*Utlv*  in*" Ur  rat*  vector 
ooapoaMt*  about  tb*  loetl  *ait  ail*  cod  MrructrUl  pole,  rvip*«ll**ly.  Altitude  1*  obUlotd  M  tb*  lot*ir*l  of 
T«bl*l«  viloclty  «ltb  r«ap*c?  to  tb*  t«rtb  lion*  tb*  local  vtrtlcil  call: 

iw  *  1 


•tor*  t*  th*  coaputid  vehicle  latitude,  U  th*  eo*put*d  vtblcl*  lonittud*  and  b.  1*  tb*  ccaputad 
v*hl*U  altitud*. 

A  blech  dlairaa  tlluitratui  achvuttctUy  th*  Mehulutlca  of  t  6cboUr*tun»d,  nortb-*l*v*d,  fr**-lnirtl»l 
■avlattle*  u»ti»  diflmd  by  tquatloa*  1*  Mom  la  fliur*  1. 


X'rizs&l at 


w 


Hi  i4viiufia  el  utlv'ii  an  leertlel  eeimor  derive  frte  tbe  evdlebllltp  of  vehicle  attitude  lafometlon 
free  U*  plat  font  HebeU  end  draealeall/*e«aet  ubeag**  ie  vehicle  velocity  obtained  Ira*  tke  ercelercMtn1 
UMimeete,  Thao#  treee  of  iefenetiae  ere  uiuillr  iteeiurv  (or  the  opartticet  of  ether  ntiealee  aubayeteea 
la  Um  vehicle.  .ho  aele  draeheag  la  eaplwUi  u  ieerttel  iretea  for  euloeoaeue  eeelteilaa  ie  thet  th  >  errore 
la  wl*t fere  ettltede  aad  OHaru'et*  vehicle  poeltloa  cad  velocity  have  eectlUtcrr  behavior,  etoehaetlc  aolae 
neurone  e|  11  therefera  eeuea  «a bounded  divergence  li  three  errore  ta  ‘he  operettm  ttee  |wr«taee.  To  re*ei« 
tke  valuable  feeuree  •(  the  leertlel  viteu  operetleo  Mile  counteract  ini  the  Jlvirjent  aad  eeellletorr  error 
ekaraeurietle,  other  eeaeore  have  bees  lacoi  .orated  to  oavieatiea  iriteai  tj  obteie  hound*  oe  the  inertial 
ejetM  errore.  Tbeee  au.lllenr  eeaeore  aeaeura  ecac  cneponeut  of  poeltloa.  the  rave  of  eraeee  ot  poeltlon  er 
tanUr  srleatatloa.  lieea  the  error  la  to  la  aeaeured  verltbla  ta  eenarellr  boundid,  at  lee»»  a  bound  In 
detained  far  the  relevant  inertia!  ejeten  error  in  the  Inti, rated  nvliatiui  eratee, 


la  appreelatlaa  of  tho  eoapletltp  of  tba  augnented  inert lal  navigation  oritta  deelgn  praklea  It  eolned  ‘(trough 
a a  etaalaatloa  of  tho  riuatleaa  doeeriblng  the  errore  In  the  leertlel  e.vetaa  nutputi,  1  reecriptlan  ehleh  le 
adequate  for  aoat  eppl.citlooe  lo  obtained  eith  a  net  of  nine  tlaa.vertent,  linear  di  f/ereotui  equnt'oan  aith 
atechaotle  iipete.  Tbeee  eeuettoaa  cea  be  obtained  bj  differencing  the  eete  of  Equal  tone  (1.1),  (J. 5)  end  (J.i) 
frea  thana  anae  equation!  eipreened  la  terae  of  onlr  true  velueo  of  'he  v.rliHee  Involved,  hr  then  latroduelod 
the  effect#  ot  errore  ta  the  eceeleroae.ire  and  gyrva,  nod  then  hr  liaorlnc  ncond.ordar  term  la  the  error 
mrlebUo. 


The  verlehlee  need  to  repreeent  error  la  the  martini  oavlealltr  e/eter  are  defined  u  foMcere,  ebnre  the 
tree  enlee  of  the  vtrlebles  in  qnentloo  ire  double  tubecrlptfd: 

ft  l\,  -  >.] 


M,  ft  W,  -  ♦) 

II,  ft  th,-ll  *•  *’v . .  ' 

•re  the  trrard  la  the  ecapiited  tehlele  longitude,  ietitudt  eaJ  altltada,  reepeot  ivejyi 

l»«,  ft  (f|#  -  »«J 
It,,  ft  t¥„  -  t,l 

;.,;rc7,  .....  .  *u  •  <*«.-*>  ,1,.' 

are  the  errere  lu  the  eoaputed  veblele  eut,  eorth  aad  vertical  velocity,  reepeettvely,  *„  la  the  error  la 
•eaputed  apparm  trevltr  nngnltude. 

free  theca  definition  the  folloelnc  errore  in  the  ooaputer  rete  of  ro'ntien  of  the  loaat  eeotrtphlo  niee 
alth  reepeot  to  the  earth  ead  eoaputed  certh  i«te  (bout  the  eorU  nod  vertical  ni*i  are  dertvad  ta  flrat  orderi 
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Tba  flrat  cat  of  differentia!  eouitlehi  liven  belov  dnertbee  tbe  angular  deviation  •(  ‘.he  areeleroaeter 
aoordlaatf  atae  free  the  ly.al  geographic  eoordioete  niee.  Tfeie  platfora  attitude  error  la  ehtalaed  by  Integra* 
tied  .ha  dlffareeaa  la  tba  laataataaaoaa  rate  of  rotetloa  ot  the  actual  platfora  aad  local  geographic  noordlnnte 
atee  vita  remit  ta  Ucrtlal  epaei.  au.ee  It  la  convenient  to  perfera  tkla  lttegraUea  la  the  ’goal  geographic 
frnae,  thee#  errorn  are  defined  bj  tbe  'brae  different!*!  equetiooe: 
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The  uoond  ut  of  differential  equation*  ducribii  thi  propiietton  of  trror  in  tin  computed  veluoe  of  nit, 
north  ind  virtlcil  vilooity: 

•i 

~  t«v„]  -  W*Bn  -  *Nst]  +  v,  -  [«p.+'jsn]Nov*  -  [p  +  *Vvl#  + 

+  up  t  isn]tovN  +  [p  +  amtsvHc , 

~  t*vH0]  E  W*s*  -  VJ  +  -  tip  +  asra  aovB  -  [p  +  ,1V,.  + 

(3.8) 

+  */5ioV,  +  , 

"  t*v,„]  »  C4>nS.  -  «V>H]  +  V1  -  S/’icVnc  -P,SVN0  -  Sgtd  + 

+  [ip  +  aSQ)  Hov,  +  [p  ♦  aQ3NSv.0  , 

whin  ygiN|Z  ire  itochutlc  functlone  repraunt.lni  genereliwd  measurement  error*  In  the  test,  north  ind 
virtlcil  eoceleromitere. 


Thi  final  ut  of  differential  iquitlon*  deaarlbsi  the  propagation  of  irror  in  tho  computed  viIubb  of  veliiole 
lomltudi,  litltudi  ind  altitude: 


“  [&s]  »  +  P*  tM  ®  S*sl  »*s  * 

i[a«8]  *  .a flu 

&  CSh«]  *  Sv*«  • 


(3.8) 


A  block  dlurta  llluatretlni  thi  linear  error  modal  of  thi  livil  channel*  of  a  Bohulir-tunid,  north-ilavid, 
frii-lnirtlal  navliatlon  lyntia  deflnid  by  Equation!  (3.7)-<3.9)  ii  ehown  In  Figure  3, 


Du*  to  thi  itochiitlc,  tlai-variant,  mltl-varlabli  fora  of  thin  irror  equation*,  thi  applioetlon  of  oliMlnal 
friquinoy  doaain  and  roat-looui  tichnlqui  1*  not  effective  for  irror  controller  dulin  unliai  ueumptione  cm  bi 
aid*  which  aiapllfy  thi  iquation*.  In  noat  ipplloatloni,  auoh  aaiuaptlona  mult  In  oonitralnta  on  the  manner 
in  vhloh  thi  ayitm  li  apiratod.  Tor  exempli,  platfora  allinmmt  michanlaatlona  havi  bun  dulinid  with  olaiiloal 
approaohea,  illuming  tlm-tnvirlandi  and  minimal  coupling  bitwein  irror  varlablii,  Such  aaaumptloni  are  only 
valid  If  thi  vihlola  under, on  no  aociliration,  whloh  uonitrair.s  lyitim  opiratlon  eliniflcantly.  alnoi  Kalman 
theory  kdoaaaodat**  thi  tlmi-varlant  aharacter  of  naviiation  lyitia  bihavlor,  only  opiratlonal  condition!  whloh 
nqulri  a  non-Umar  daioriptlon  of  error  behavior  nud  be  aVoidld  whin  thli  approaoh  1*  employed.  Moat  dealm 
Iftorta  uiln,  Kalman  oonaept*  for  irror  control  dial  with  the  mlnlniaatlon  of  miohnrlmatlon  complexity  that  oan 
bi  obtained  for  thi  (Ivin  ayitm  performanoi  requirement-*,  Digital  ooaputers  ari  naually  riquirid  to  dial  with 
thli  ayntheaic  problem  iffwotlvaly, 

Thi  Introduction  of  Kalman  thaory  haa  halpid  to  ohangi  thi  vlawpolnt  of  analyati  in  augmintid  lmrttal  navi¬ 
gation  ayatam  dialgn  from  oni  In  whloh  varioua  othir  union  limply  aid  tha  inertial  ainanr  In  pirfarmln,  thi 
navigation  funotlon  to  one  whin  each  aisior  ii  rigardtd  »a  •  louruu  of  information  evillabli  to  the  navigation 
ooaputar  to  bi  uaed  in  deriving  valuia  of  thi  riquirid  navigation  varlablii,  Kith  thi*  niw  viewpoint,  thi 
ayitim  output!  at  any  lnatant  of  tlmi,  rigardlui  of  vihlola  flight  dynimioi  or  lntarmittmt  availability  of  data 
from  any  lonaor,  oan  bi  optimal  In  thi  linn  that  ill  information  hu  bun  fully  utlllaid.  Thli  oompliti  abeorp- 
tlon  of  unior  date  1*  rialiaid  through  thi  uai  of  oorrilatlon  Information  contalnid  In  thi  lyatem  trror 
oovarlano*  matrix,  Tha  use  of  thli  matrix  ai  i  bull  for  miuurimint  data  mixing  in  Kxlman  flltaring  oonitltutn 
thi  unique  end  novel  empiat  of  thli  duign  approach,, 

Khin  Xilmin  thiory  li  applied  to  tirrutrlil  navigation  lyitimi,  tha  oovarianoi  aatrlx  la  propagated  in  real- 
tlu  in  thi  eyetem- computer,' due  to  the  unpredictable  neturo  or  vihlola  maneuver*  end  navigation  ainaor  data 
availability,  Aa  a  coneequence,  thi  Initentinioui  etitiitloil  ititi  of  the  ayetea,  refliotid  by  the  oovirlanoi 
Mtrlx,  1*  alweya  eviilibla  to  inible  optlmil  utUicitlon  of  niw  unior  miuuriminta.  In  followlm  uctlnni  we  , 
will  dilcrlbe  thi  minner  in  which  Kalman  filter  oonoipti  in  imployea  In  error  oontrollir  deilgn  for  auimentid 
Inirtlel  navigation  lyitmi.  for  thi  present  we  ducribi  thi  manner  in  whloh  different  naviiation  union  hivi 
bun  uiod  to  control  inertlil  navigation  ayatim  error*  with  mora  conventional  eyatem  miohinlxationi. 


3.3  Doppler-InirtUl  Navigation  gyitim  Opiratlon 

In  a  Doppler-Inertial  naviiation  ayatim,  the  unior  which  lugmenti  thi  Inirtlel  unior  la  thi  Dopplir  radir. 
Thi  Dopplar  radar  liaauru  thi  friquinoy  ehlft  between  i  tnnimittid  ind  rifiioted  radio  wivi,  Thli  Doppler 
ahift  la  proportional  to  the  ipied  of  the  vihioli  with  rupict  to  thw  rifliotlm  surface  ilom  thi  diriotlon  in 
whloh  the  bum  of  mii'gy  lm  trimmlttid,  Doppler  redari  havi  bun  developed  which  oan  provide  thru  Independent 
ooapomnti  of  vihlola  ipaid.  Thuo  oomponinti  ari,  however,  exprcuid  In  a  coordinate  lyitim  related  to  the 
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Doppler  antenna,  whom  orientation  la  not  known  with  rnepaot  to  tha  aarth.  Consequently,  i  Doppler  radar 
oannot  perform  tha  navigation  funotlon  autonomously,  but  require*  that  the  Doppler  anlenrm  bo  atublllxad 
mechanically  or  computationally  unini  attltuda  information  pruvldad  by  an  martial  platform  or  aomo  other 
orlantation  rafaranoa,  Onoa  tha  atsblllaatlnn  of  tha  Doppler  xpnod  maenurimente  la  aohlavad,  vehicle  velocity 
with  raapact  to  aarth  atom  the  local  cant,  north,  and  virttcal  ataa  la  known,  allowing  changes  In  vehlola 
position  with  raapaot  to  tha  aarth  to  be  obtalnad  from  Integration  In  tha  ayatim  computer, 

Tha  arrora  In  the  determination  of  vehlola  apoad  In  antannn  coordinate*  from  the  Dopplar  frequenoy  shift  are 
du*  to  various  equipment  calibration  errors  (e.g.,  antenna  tomperatura  ahlfta,  boom  mlenUgnmanta,  etc.)  and  the 
atatiatlcal  character  of  the  beam  rafleotlni  surface  over  ahieh  the  vehicle  travels.  Bluet  the  beam  has  finite 
width,  for  a  liven  vehlola  apaad  a  continuous  apaotrum  of  Dopplar  frequency  shift  Information  la  extracted  from 
the  reflected  beau.  Thu  centroid  of  thia  return  la  usually  ti poked  and  a  acale  aaelgnad  bauM  on  nominal  aperat- 
lng  eondltlona,  If  the  oliaraater  of  th*  reflecting  terrain  changes  markedly,  the  enalgiicd  scale  fnotor  will  be 
in  error,  Mont  of  thin  type  of  difficulty  In  uaing  Doppler  rndnr  occur*  over  water  where  tha  nurfnuo  nmoothneee 
distorts  the  return  npuctrum,  such  problcmn  have  been  solved  to  some  extent  by  beam  lobtng,  Over  very  smooth 
■urftoaa,  however,  the  Doppler  rndnr  output  cannot  bn  used,  an  insufficient  return  energy  is  received.  Autonomous 
navigation  with  Doppler  rndnr  In  aliu  degraded  in  uvor-witer  operation  when  surface  ourronta  exist,  Without  sn 
independent  refnrsnne,  nnvigstlon  with  respaot  to  the  moving  surface  rather  than  the  earth  takas  place.  The 
Important  characteristic  of  the  Doppler  errors  Is  that  they  eon  be  expressed  n»  bounded  fixed  freottonn  of  the 
vehicle  speed  component*.  Consequently,  the  errors  In  the  Dopplnr  speed  components,  expreoaed  along  the  platform 
coordinate  axes  after  data  stabilisation,  ara  bounded,  Proper  blending  of  thex*  data  with  the  velocity  component* 
obtained  from  the  inertial  system  will  rnult  In  a  lyatem  which  has  error  ooeiponente  along  these  niee  which  are 
less  than  tha  bound*, 

In  t  conventional  coupling  of  tha  Dopplar  and  lnartUl  data11,  tha  velocity  component*  obtained  from  each 
sensor,  or  other  suitable  Independent  function*  of  these  variables,  tr*  differenced  from  each  other.  Por 
sufficiently  email  errors,  these  differences  san  be  expressed  is  a  linear  combination  of  various  errors  asaoolated 
with  tha  Doppler  end  Inertial  isiiaor*,  These  signals  osn  then  be  fed  beck  to  correot  or  compenente  the  different 
eouross  of  error  in  the  navigation  ayatem,  The  eventual  desired  raault  la  the  reduction  of  error  in  all  the 
navigation  ayatem  outputa,  A  block  diagram  illustrating  a  conventional  ground  epeed'ind  drift  angle  damped  north- 
slaved  Inertial  navigation  system  miohanlsation  la  ahown  in  Figure  4,  It  oan  be  lean  in  this  figure  that  the 
difference*  between  predicted  end  Doppler  measured  ground  speeil'ind  drift  angle  ere  fed  back  through  gain*  to 
correct  the  computed  north  and  emit  velocities  and  altar  the  computed  platform  apatlal  rata  oompononta. 

1,4  LORAN-lnertial  Navigation  lyatem  Operation 

In  a  UHANilnertlal,  navigation  -system  .the  data  uesd  to 'augment  the  inertial  ayabeg  In  performing  the  navigation 
function  la  derived  from  e  LORAN  tige-differeno*  receiver,  LOliAN  employed  as  an  autonomous  nsvigstlcn  system 
provides  position  information  only.  .The  position  is  dgrived  {row  maiaurnments  of  the  difference  between  the  local 
til*  of  receipt  of  pulsee  transmitted  from  etstion*  it  known  position  on  the  surface  of  the  earth,  At  Inset  three 
station!  ere  required  If  a  oompleta  politico  fix  is  to  be  obtained  from  LORAN,  One  of  the  etationi,  oalled  tha 
maatar,  tranamlta  the  flrut  pule*,  This  pulse  when  reonlved  by  the  twu  other  etationi,  whloh  are  oalled  slave*, 

Is  then  retransmitted.  Upon  reaelving  the  muter  pules,  the  LORAN  rndlo  receiver  In  the  vehlola  etert*  n  prealne 
clock  which  meeeurti  the  time*  until  the  puleee  ere  raaelved  from  the  slave  station*,  The  oonetant  dlfferenoo 
of  the  dletanoee  from  two  fixed  points  define*  e  hyperboloid  in  space  with  the  nation  poaitiona  as  the  foci, 
Consequently,  the  time-difference  measurement  obtained  from  a  mnater-slave  station  pair  will  locate  the  vehicle 
on  euoh  a  surface,  Assuming  the  vehlola  la  near  the  eurfics  of  the  earth,  s  Un*-of -position  la  defined.  When 
a  second  time-difference  naeiuramant  creetse  a  line-ot-poilUon  which  lnteraeota  with  the  other,  the  position  of 
the  vehicle  la  defined.  The  mean  that  tlsa-dlffaranoa  la  moaaurad  In  LORAN,  an  oppoasd  to  the  Mm*  It  takas 
a  pulsa  to  travel  from  a  atatlon  to  tha  vehicle,  1*  that  thara  la  than  no  requirement  for  praola*  synchronisation 
of  the  vehlal*  and  atatlon  olooka  with  an  sbaolut*  time  atandard.  If  praola*  synchronisation  wtr*  achieved,  the 
derivation  of  rang*  to  two  atatlona,  uaing  an  abaoluta  tint  standard  and  a  tlma-of-recaipt  reoaiver  on  the 
vehicle,  would  suffloe  to  obtain  a  complete  position  t lx  on  tha  earth' a  eurfsci, 

Irrora  salat  In  tha  datarmlnation  of  true  tima-diffarenca  at  tha  vehlola  for  t  variety  of  reasons,  Including 
■ynohronlantlon  error  at  the  slave  atatlona  in  pula*  retransmission,  ambient  receiver  and  atmonpheria  nole*  and 
local  radio  interference  mar  tha  vahials,  Another  Important  acurca  of  error  la  that  associated  with  tha  lack 
of  praola*  knowledge  of  tha  spied  of  propagation  of  alaotromainatlo  anargy  over  the  aarth' a  lurfaoa,  Thla  la 
caused  by  stoohaetlo  variation*  in  ths  propagation  path  definition,  The  result  i*  an  actual  tlma-dlffaranoa 
grid  whloh  la  distorted  relative  to  that  pradiotad  using  gcodatlo  data  only. 

Tha  Important  oharaotai'litlo  of  than  error*  in  tha  ueu  of  LORAN  in  aiding  tha  inertial  system  In  navigation 
1*  that  they  ara  bounded,  Hanoi  tha  error  in  position  obtalnad  from  ths  tima-diffartno*  maasurinent*  In  trass 
of  dsflnad  LORAN  coverage  will  serve  as  an  upper  bound  on  the  poaitlon  error  for  the  navigation  ayatem,  Proper 
mixing  of  ponltlon  Information  fros  the  LORAN  and  Inertial  eeneora  san  reeult  In  lens  arror  in  ail  ayatim  out¬ 
puts  than  oould  bn  aohlavad  with  althar  aanaor  operating  autonooouely. 

In  a  conventional  coupling  of  Information  from  tha  LORAN  and  Inortiel  union,  tlaa-dlfference  predictions 
derived  from  the  lnartlal  eyetea,  or  pradiotad  geofrephlo  position  information  derived  from  the  LORAN  measure¬ 
ment!,  are  subtracted  from  tha  appropriate  variable  from  tha  nther  senior.  Por  sufficiently  small  errors, 
thla  difference  oan  ba  axproaead  aa  a  linear  combination  of  errors  associated  with  aaoh  of  the  atnaoru.  Conee- 
quantly,  as  in  tha  Dopplar-lnartlal  ayatam,  the  aams  basis  exists  for  th*  dneign  uf  a  linsar  faadbaok  controller 
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to  reduo#  th*  error*  in  the  output*  of  th*  eyatein,  Thin  bails  ht*  been  exploited  in  the  put,  where  tlnie- 
inverient  'vror  ountrol  mpohmiem’  hnvt  been  dealgned,  These  auchnnlsationa  ere  usually  far  from  optimal  owinii 
to  the  (orementlonod  limited  applicability  of  th*  time* invariance  assumption  for  the  inertial  error  model,  aa 
well  a*  to  th*  varying  quality  of  time-difference  data  aa  the  vehicle  move*  through  a  I, ORAN  coverage  arna.  The 
une  of  Kalman  filtering  concepts  in  the  design  of  aueh  a  navigation  system  offers  great  hanofita,  aa  the  time- 
variant  behavior  of  the  error  oan  be  accounted  for  automatically  on  a  real-tlnn  basis. 

3, S  Astro-Inertial  Navigation  System  Operation 

Th*  final  navigation  system  to  be  dlaoueaed  is  one  in  whioh  a  atar-tracknr  la  employed  to  meaaure,  at  the 
vehicle,  th*  angular  orientation  of  aatronomloal  bodies  vith  known  celestial  politico,  Like  the  Doppler,  an 
aatro-traokar  cannot  ba  employed  aulononnualy  to  detarmine  vehicle  position.  An  attitude  reference  with  known 
orlantation  with  respect  to  an  aarth-flxed  coordinate  ayatam  must  be  provided  to  allow  an  interpretation  of  the 
lighting  ihgleg.  Normally,  the  optical  axia  of  the  tracker  ia  oriented  by  alewing  It.  through  bearing  and 
elevation  angles,  respectively,  from  an  Initial  coincidence  with  the  local  north  line.  An  netro-traoker  ueually 
inoorporatea  a  detection  and  eirvo-moolianlam  system  which  drives  the  taloBcope  elevation  und  bearing  gimbals 
until  «  detactod  light  aouroe  resides  at  tha  center  uf  the  fleld-of-vlew.  When  this  is  achieved,  measurements 
of  the  bearing  angle  from  tha  local  north  line  in  tha  Local-level  plane,  and  the  elevation  angle  uut  of  the 
local -level  plane,  can  be  read  directly  from  telescope  gimbals. 

In  an  automated  trioker  system,  th*  optical  asli  1*  urst  directed  to  a  point  in  tha  aky  whara,  baaed  on  the 
computed  viblol*  petition  and  known  egltitial  petition  of  a  ttar,  thi  star  would  bo  expectad  to  ba  found. 

Reeauee  of  error*  in  th*  oemputad  vehicle  position  and  tha  attitude  reference  uasd,  th*  star  will  deviate  from 
th*  center  of  the  fleld-of-vlew.  The  errors  in  th*  Initial  pointing  angle  oan  be  determined  by  oeuterlng  the 
ettr  and  seasurius  the  ohangta  in  tha  telasoupa'a  angular  orientation,  If  th*  angular  arrora  in  vehUle  position 
and  plstform  attitude  are  auffiolently  small,  the  pointing  anfia  arrora  aan  bn  axprtaasd  aa  linear  oumblnatlona  of 
those  error*,  '  For  aaampla,  elevation  and  bearing  angle  arrora  could  be  linear  funotiona  of  the  error*  In 
oomputed  vehicle  latitude  and  longitude,  platform  aaimuth  error,  end  th*  platform  tilt  arrora  shout  tha  local 
north  and  east  tits,  Theca  oauaei  of  pointing  angla  error  oan  ht  expressed  about  axaa  of  an  orthogonal  coordinate 
eyatM  which  haa  ona  axia  coincident  with  tha  optloal  axla  of  tno  tracker,  Bine*  th*  initial  teieocop*  orienta¬ 
tion  error  can  ba  expressed  about  axes  orthogonal  to  tha  lina-of-a'ight  axia,  tha  angular  error  component  along 
the  telaaeop*  axis  la  unobaervabla,  Th*  errore  in  th*  elevation  and  bearing  angla  measurements  due  to  th* 
tracker  eyetem  iteelf  ere  bounded.  Thee*  errore  reeult  from  mechanical  misalignment  of  tha  talaaoopa,  alaotrloal 
bias  and  noia*  in  th*  nulling  nontrol  loops,  and  environmental  effaota,  such  aa  tha  index  of  refraotlcn  of  th* 
atmosphere. 

In  a  oonventlijnil  aetro-lnertial  ayatam,  where  th*  attitude  ratwrano*  1*  ot  high  quality,  it  la  uaually 
asauaad  that  no  error  exlat*  in  th*  nUtform  level.  Correction*  era  than  mada  only  to  th*  computed  vahiol* 
position  and  tha  aaimuth  orientation  of  th*  platform.  Uaually  in  a  *tar-traok*r  ayatam,  sequences  of  ataro 
ar*  shot  to  determine  vahiol*  position.  Attar  aaoh  shot,  residual  error  ixiata  about  the  most  recant  llna-of- 
tight,  uulaaa  start  *lth  orthogonal  Unaa-ef-aight  ar*  available.  Conventional  mechanization!  usually  do  not 
oapltalil*  on  tha  ralative  orlantation  of  th*  Un«i-ot-*ight  that  *xlat  In  a  itar  ahot  eaquanoe  du*  to  th* 
bookkaaplng  involved,  By  automatloilly  accounting  tor  th*  optimal  u*t  of  all  previous  maaaurtmant  data,  Kalman 
thaory  offer*  a  much  mors  powerful  approach  for  obtaining  error  aapmration  for  thla  navigation  ayatam. 


4.  PRACTICAL  CONIIDBKATIONI  IN  USINC  KALMAN  THEORY  IN  NAVICATtON  SYSTEM  ItRRION 
4. 1  Omnaral 

Tbs  auaoataful  application  of  any  method  to  sohltv*  rial-time  error  control  in  multl-unaor  navigation  aystama 
require*  an  twaranati  of  th*  oonatrainta  imposed  by  tha  actual  hardware  available  for  tha  ayatam  mechanization. 

In  partloular,  th*  aanaltivity  of  ayatam  performance,  baaed  on  theoretical  aiaumptiona,  to  auoh  phanamana  aa 
finite  maaaurtmant  rataa  and  coeiputatlcn  error  raaulting  from  computation  equipment  and/or  cooiputntlan  elgorlthm 
ahtraotarlatloe  !-.-•*  be  datermined  tu  aetabllch  th*  effictoy  of  eny  error  oontrol  ooneept.  In  the  following 
paragraphs,  the  ‘•-..■iicmtlon*  of  tha  charaotwriatloi  of  navliatlon  oomputera  and  iwnaore  on  th*  ImpUiaentation 
of  an  arror  controilir  baaed  on  Kalman  llnaar  correlation  theory  ar*  outlined, 

4.1  Digital  Computation 

In  tha  put,  oonventlonal  augmented  inertial  navigation  system*  have  been  meahinlced  ueing  analog  computing 
element*.  Ruoh  an  approach  ie  adequate  far  vary  simple  mechanization!  whara  atrlng-mt  riqulramwnta  for  computa¬ 
tional  accuracy  do  not  wxlat,  Mora  recently ,  the  majority  of  augmented  inertial  navigation  syatema  have  employed 
varlou*  type*  of  dlgltml  computing  elements  (a,*.,  general  purpose  and  digital  differential  analyzar)  to 
aoeomplllh  th*  required  computet  lone,  gome  of  th*  advent*!**  encountered  in  th*  use  of  than  digital  oomputera 
ar*  capability  tor  iooreaeed  computational  precision  and  flexibility  in  implementing  logical  funotiona,  The 
ourrent  trend  towsrd  increased  processing  rate,  and  greater  atorsg*  at  reduced  coat  ia  an  additional  attraction. 
The  disadvantage*  incurred  in  digital  computation  stem  primarily  from  tha  finite  rat*  at  which  logical  and 
arithmetic  operations  oan  b*  performed.  Thau  finlta  rataa  aanarata  requirements  for  tbs  usa  of  computational 
algorithms  to  accomplish  mathematical  operation*.  Computational  alaorithma  can,  howavar,  achieve  only  imperfect 
realisations  of  the  desired  mathematical  operation*,  Tha  moat  familiar,  and  probably  most  important,  of  theao 
operation*  in  practice  ie  that  of  Integration.  QanuraUy,  an  error  control  mechanization  for  virtually  any 


augmented  Inert  ial  navlgntlon  bon«d  on  Knlmnn  1 1  near  oorrolatlon  theory  will  require  that  a'cunnhluruhlu 

amount  of  praclne  arithmetic  computation  ami  logical  ewitchini  ho  implemented.  Consequently,  the  use  of  general 
purpose  digital  oomputera  is  required  In  tha»*  applications. 

4.3  Advantage  of  Kalman  Mechanizations  In  Augmented  Inertial  Navigations  Systems 

Tha  asanntinl  difference  botweon  Kalman  and  conventional  navigation  aystem  error  control  methods  results  from 
the  use  of  s  oovarlsnoe  matrls,  with  thn  Kalman  teolmique  as  a  bacla  lor  computing  the  gain  to  be  used  for  system 
correction  when  a  measurement  Is  made.  The  information  contained  in  thin  matrix  provides  the  moans  by  which 
•uperlor  system  performance  can  bo  aohlevod  In  cumpnrlenn  to  thnt  obtained  with  conventional  approaches, 
Conventional  error  control  genorully  Involves  the  use  of  matrices  of  pro-stored  gains,  which  sro  determined  using 
a  priori  assumptions,  The  use  of  the  different  gain  ante  la  diotated  as  the  real-time  operating  conditions  of 
the  system  are  ascertained, 

As  already  noted,  an  error  model  for  a  navigation  system  is  represented  by  sots  of  time-variant  equations, 
fllnoe  there  is  Infinite  variety  of  possible  flight  end  sensor  data  proflleH  for  a  navigating  vehicle,  tho  actual 
realisation  of  these  equations  osn  only  be  made  In  ronl-ttmo.  Therefore,  the  nuture  of  navigation  system  error 
propagation  requires  that  a  aousldersble  number  of  gain  matrices  be  Btored  .In  the  digital  computer  to  runlize  a 
conventional  mechanization  which  acoounts  to  any  extent  for  the  many  aeqnmicen  of  ayntem  operating  conditions 
possible.  Usually  this  la  not  dene  In  conventional  designs,  with  tho  rosult  thnt  restrictions  on  operational 
capability  of  the  vthiolt  art  Imposed  to  aooommodite  tha  mechanization  inndequaolaa,  Buch  restrictions  on  tha 
operational  capability  of  a  system  art  extremely  undesirable  and  can  be  avoided  by  using  more  sophlatioated 
Kalman  trror  control  technique*. 

Tha  Kalman  error  Control  mechanisation  avoids  construct*  cn  vehicle  operation  through  real-tima  propagation 
and  update  of  the  error  covariance  matri.*.,  Tha  actual  realisation  of  arbitrary  functions  of  time  (o.g. ,  accelera¬ 
tion  and  velocity  component*)  praaint  In  th*  differential  gQuatlnna  describing  system  error  era  used  In  the 
•rror  aova'rlanca  matrix  propagation,  resulting  In  g  comet  rapraaentation  of  th*  ayatam  error  state,  Alan,  the 
arbitrary  availability  and  variation  in  quality  of  tenser  naaeuremant  data  during  ayatam  oparatlun  Is  properly 
accounted  for  through  rial-time  updnt*  of  tha  arrer  oovarience  matrix  on  evatarn  corraotion.  Real-time  availa¬ 
bility  of  acneor  data  la  arbitrary,  as  th*  aanaora  may  b*  intermittently  operebla,  For  example,  accurate  track¬ 
ing  of  LORAM  time-dltfersnosi  can  ba  interrupted  In  the  praaance  of  high  itrength  interference,  Sensor  data 
quality  alao  varies  with  tims  aa  th*  vehiola  movaa  Into  rations  affaotlng  senior  operation.  With  LORAN,  the 
signal  to  noise  ratio  aaaociated  with  Information  lent  from  a  station  usually  drops  as  the  dlstano*  between  th* 
vehicle  and  tha  trinimlttar  lnoraaaaa.  Th*  auality  of  Doppler  data  changes  with  th*  terrain  over  which  tha 
vahiol*  travels,  the  antenna  attitude,  and  th*  valilol*  speed  end  altitude,  all  of  which  vary  with  tlmt.  Astro- 
tracking  capability  depends  on  thi  affeativ*  brlghtnais  of  available  atari  at  tha  position  ofthe  traoksr. 

4.4  Senaor  Meaeureaent  Proclailng 

Olffsrant  formulations  of  tha  Kalman  filtering  equations  hive  bttn  obtained,  Tha  initial  derivation1  assumed 
that  the  observation  or  measurement  process  was  continuous  and  that  each  maasuramant  wai  contaminated  by  an 
addltiva  whit*  noli*,  In  praotio*  naithar  of  than  assumptions  oan  actually  ba  isalicwd. 

In  tha  first  case,  contlnuoua  laaiuramantu  cannot  ba  asaumwd  whin  tha  aquations  era  implamintad  on  a  digital 
computer,  as  th*  computer  can  aohlave  only  a  finite  rate  of  prootesliig  and  will,  additionally,  b*  requirad  to 
perform  funotlons  other  than  that  of  error  aontrol,  Consequently,  In  applications,  only  a  finlt*  rata  of  adsorp¬ 
tion  of  aanaor  data  oan  b*  realized. 

The  raqulresant  for  addltiva  wblta  noli*  contamination  of  the  msaaurwments  in  the  Initial  formulation  alao 
praaanta  dlfflcultlaa,  In  all  oaata  the  assumption  that  the  msazurement-oontzmlnzting  noise  has  short  correlation 
time  with  raipeot  to  tha  system  time  constant!  oannut  he  made.  A  senaor  In  tha  process  of  wxtraotlng  Information 
In  tha  praaance  of  ehort-term  noli*  employs  aom*  filtering,  Tha  filtering  nsiooiated  with  Mill  detection  process 
will  have  the  effects  of  correlating  and  reducing  the  magnitude  of  tit*  contaminating  noise  process  and  Introducing 
dynamic  arror  in  tha  information  being  miiiurid,  Equipment  biases  ire  further  examples  of  long-term  errors 
present  In  msaeurementi, 

The  practical  aspaota  resulting  from  digital  implimantatlon  and  aanaor  maasuramant  smoothing  hav*  usually  lad 
to  tha  uae  of  tha  augmented  atate  formulation  of  the  equations  with  diaoreta  observations  in  applications*,  in 
tbia  approach,  coupling  between  the  individual  aansor  subsystem*  la  realized  only  at  time  indents  whan  tha 
oomputar  procesaea  aanaor  data  to  malt*  ayatam  correct  lorn,  Between  tliese  update  initants,  th#  covariance  matrix 
describing  modeltd  system  errors  is  propagated,  reflecting  the  non-interaction  of  errors  in  th*  individual  sensor 
aubiyitima,  At  the  update  tlma,  measurement!  are  made  and  compand  with  pradiotad  values  thus  obtaining  observed 
errors  which  ere  weighted  with  the  Xalaan  gain  to  provide  corrections  to  the  modeled  eyattn  errors. 

Sinoa  tha  original  derivation  of  th#  Xalaan  filtering  equations,  an  alternate  formulation  by  Bryaon  and 
Johansen*  has  bean  obtained  whioh  does  not  raqulre  the  ozauniption  that  meaaurenanti  are  oontaainatad  by  white 
noise,  With  this  formulation,  continuous  absorption  of  ssnaor  data  oontamlnatid  with  correlated  noise  is  theorw- 
tioslly  possible.  The  dimension  of  this  filter  la  lees  then  that  of  the  zupisntod  state  form  by  the  number  of 
meaeureminti  oontamlnatid  by  flrit-order  correlated  noiao.  Tbs  amount  of  computation  required,  however,  la 
greater  than  that  of  th*  original  formulation  for  filters  of  the  aims  dimension.  The  Bryson-Johausnn  formulation 
wee  extended  to  the  discrete  case  by  Bryson  and  Henrlkaon1,  Tills  formulation  la  equivalent  to  th*  augmented  atnte 


formulation  «lth  tin  discrete  zoasuremnnU  made  at  a  f ini tu  rate.  However,  In  the  Unit,  thu  liryecm-lienrikson 
filter  aonvsrgei  to  th«  Rryaou-Joluuison  filler,  while  the  augmented  otnt o  formulation  Is  not  uoflnnil.  With 
continuous  absorption  of  sensor  data,  possible  for  the  osso  where  only  oorrolnietl  noise  bx1»u  in  the  soneor 
measurements,  tho  augmented  state  fnnmilatlon  with  dlscroto  observations  will  be  comparatively  lass  optimal, 
Results  obtained  by  ttryson,  Johansen  und  llonrlkaon  Imply  tliut,  as  the  sensor  sampling  rate  Is  lnornused,  pur- 
fonsanee  aohieved  with  the  augmented  state  formulation  will  tend  to  the  theoretical  optimum  obtained  by  Bryson 
end  Johansen,  until  computational  Instability  Is  reached.  This  result  has  been  demonstrated  by  Rleohel*. 

If  the  frequencies  associated  with  the  difference  of  a  sensor  measurement  end  the  predicted  value  of  that 
metzurement  baaed  on  syitem  computed  nuvlgutlon  variables  arc  long  with  respnot  to  the  measurement  sampling 
frsquenoy,  then  them  will  be  little  benefit  In  faster  measurement  numpllhg.  In  erulee  nnvlgatlon  system 
applications,  the  aensor  campling  Intervale  selected  are  seldom  much  shorter  than  the  correlation  time  associated 
with  the  highest  frequency  noise,  Shorter  sampling  periods  have  little  utility  except,  perhaps,  during  the 
time  when  tho  Inartisl  platform  is  being  aligned,  During  this  period,  error  deviations  In  system  position  and 
velocity  will  ooour  relatively  more  rapidly  due  to  the  largo  platform  attltudo  errors,  Therefore,  a  higher  rets 
of  system  oorreatlon  would  be  desirable  for  obtaining  tighter  hounds  on  these  errore, 

The  augmenting  eeneare  in  augmented  Inertial  navigation  eyet.ems  havs  time  C'Uietante  associated  with  their 
individual  Information  processing  procoduren.  If  t! esc  time  oonntants  are  long,  significant  dynamic  error  can 
result  in  the  aensor  output  measurements.  The  dynamic  lnaecuraolaa  are  ununlly  due  to  vuhlclu  maneuvers,  In 
■ait  systems,  acceleration  information  from  the  inertial  platform  can  be  uaed  to  oompanaatB  tho  dynamic  error 
associated  with  the  augmenting  aensor,  This  hai  been  demonstrated  In  conventional  (.ORAN-lnertlal  systems’, 
where  the  rate  of  changa  of  time-difference  has  been  supplied  tu  the  LORAN  receiver  from  the  Inertial  nyatem. 

Such  a  mechanisation  relieves  the  receiver  from  the  task  of  traoking  dynamic  ahangas  In  time-difference,  at 
laaet  to  the  limits  of  the  inertial  errors,  thereby  committing  it  primarily  to  the  teak  of  separating  transmitted 
Information  from  noise,  When  thle  is  done,  long  receiver  time  ounetente  an  the  order  of  many  eeoonde  oan  bo 
ratalned, 

In  aoat  oust,  the  additional  dnslgn  complexity  Implied  by  euch  an  approach  may  not  be  desired,  What  ie  done 
in  these  situations  is  to  selaot  time  constants  which  achieve  *  balance  betwaen  stochastic  and  dynamic  arrnr  In 
the  aansar  processing  daslgn.  In  Doppler-Inertial  navigation  systems,  the  time  constant  nf  the  frsquenoy  ehlft 
tracker  in  the  Doppler  radar  asn  be  short,  an  the  order  of  0.1  second,  The  purpose  of  employing  short-time 
constants  In  the  detection  process  ie  to  minimise  the  dynamic  error  in  the  variable  being  measured.  When  short- 
time  constants  are  used  in  the  seneor  filtering  networks,  a  system  correction  utilising  thn  Kalman  filtering 
equation!  at  comparable  rates  may  not  bo  achievable  due  to  allocation  of  computer  time  to  error  control.  When 
this  oooura,  methods  aunt  be  devliad  to  minimise  the  Information  loss  resulting  from  tha  alow  sampling  rate. 

The  moat  popular  taehnlqua  for  minimising  this  information  loss10  raqulraa  a  high  rate  of  comparison  of  the 
seneor  leaauvaments  and  tha  predicted  valuea  of  theee  measurements,  These  differences,  takan  at  the  desired 
•sapling  rate,  can  be  lnearted  into  a  pre-filter  for  smoothing  between  eyatem  correction  Instants.  Tha  pre- 
filtering  will  reduce  the  random  aensor  noise  In  this  error  difference,  thereby  improving  the  relative  lnforma- 
'  tion  content  at  the  eyetem  update  time.  Note  that  thle  scheme  does  not  introduce  dynamic  error  in  tha  senior 
meaeureaent,  as  only  the  error  difference  information,  act  tha  sequence  of  whole-value  measurements,  le  being 
filtered,  Coneequently,  the  edvantage  gained  In  minimisation  of  dynamic  error  in  thu  meeeuremente  through 
the  ues  of  ibort  eeneor  filtering  time  conetanta  le  retained,  while  the  lnforsatlon  content  of  the  obeerved 
error  used  tor  eyetem  oorreatlon  le  improved. 

A  flrat-order  representation  of  thle  pre-fllterlng  approach  la  Indicated  schematically  in  Figure  5.  Hare 
predicted  valuea,  m  ,  are  differenced  with  the  rew  measurements,  m  .  Theee  differences  are  weighted  with  a 
filtering  gain,  k  ,  and  used  to  update  e  summing  register,  At  the  eyetem  update  time,  the  smoothed  difference, 
f  ,  le  weighted  with  the  Kalman  gain  to  obtain  the  eyitom  correction.  The  eumlng  register  le  usually  ztroad 
whenever  its  contents  are  used. 

The  principal  characteristic  to  investigate  before  employing  euch  n  mechanization,  la  the  degree  of  distortion 
Imposed  ou  Information  passing  through  tha  pre-filter,  Unless  tha  pre-fllterlng  le  modeled  in  the  Kelmen  formu¬ 
lation,  the  actual  error  uhareoteriatloa  differ  from,  the  modeled  error  ohareoterletioe.  In  augmented  inertial 
navigation  eyitam  application!,  aerloue  distortion  will  usually  only  occur  during  platform  alignment  modes.  For 
these  ceaem,  an  analysis  of  the  distortion  of  error  signals  due  to  platform  attitude  error  due  to  pueeage  through 
the  pre-filter  should  be  made.  Workablo  levels  of  dietortiou  can  be  obtained  with  an  appropriate  selection  of 
tensor  end  pre-filter  time  constants  and  the  system  update  interval. 

In  this  notion  we  have  considered  eooe  of  the  preotloel  problems  which  arias  In  actually  implementing  a 
given  error  controller  In  the  navigation  ..omputsr.  In  augmented  Inertial  navigation  eyeteoe,  digital  computers 
are  required  for  the  complex  arithmetic  and  logical  operations  aesooleted  with  a  Kalman  error  controller.  Real¬ 
ties  propagation  of  the  eyetem  error  oovtrltnoe  matrix  le  required  to  accommodate  the  reel-time  dynamic  maneuvers 
of  the  vehicle  and  the  pocslble  Intermittent?'  and  variation  In  quality  of  sensor  data,  Finally,  the  reaeons  for 
finite  dleorete  simp  ling  of  eeneor  data  for  eyetem  correction  were  dieoueied  and  a  method  for  minimizing  Informa¬ 
tion  loss  wai  noted.  In  the  next  eectlon,  an  approaoh  lz  presinted  which  hex  been  ua«d  to  allevlata  acme  of  the 
ooeiputatlonal  burden  lmpoetd  on  tha  digital  computer.  Thle  approach  deals  with  the  eyntheaie  of  the  error 
controller  rather  than  the  technique1,  described  for  its  Implementation. 
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The  control  of  error  In  any  system  require!  a  definition  of  tha  aourcea  of  error  and  their  dynamic  behavior. 

If  the  error  model  for  the  »yeteiu  le  deeoribed  by  linear  differential  equation*  with  random  initial  condition* 
and  white-noise  driving  function*,  it  le  a  simple  matter  to  diroctly  apply  Kalman'  e  filtering  theory  for  the 
control  of  thoie  error*,  if  the  model  1*  non-linear,  either  a  linearization  must  be  mad*  or  a  different  control 
algorltha  muat  first  be  employed  until  the  error*  aro  reduced  sufficiently  for  linear  behavior  to  be  realized. 

The  linear  differential  equation*  describing  navigation  system  error  are  foretd  by  atochaatlc  function*. 

TYien  stochsetlc  driving  functions  hive  various  degrees  of  auto-oorrelation.  ranging  from  biases  to  asacntlally 
white  oolae  terse.  To  devise  dynamic  models  for  such  noise  errors,  correlation  functions  are  derived  from 
empirical  data  obtained  about  the  nolee  sources,  Linear  dynamic  systems  excited  by  white  ncise  are  then  ayntho- 
sised  from  an  analysis  of  these  describing  correlation  functions  to  represent  these  error  sources  in  the  total 
systtei  error  model.  Thus  for  multi-sensor  navigation  systems,  information  whioh  is  available  about  errors  usually 
remits  In  the  definition  of  tn  extensive  llnesr  error  model.  The  application  of  Kalman  theory  employine  such 
error  models  results  In  significant  computer  computetlon  time  and  atorago  requirements.  To  reduce  these  computa¬ 
tional  requirements,  various  methods  have  been  tried  in  order  to  find  simpler  error  control  schemes  whioh  still 
obtain  the  benef  del  correlation  property,  One  of  the  most  successful  of  these  methods1  Involves  the  study  of 
the  complex  error  model  itself  to  determine  whet  simplifications  can  be  made  to  reduce  the  computational  burden. 

In  this  approach,  on*  employs  to  advantage  thu  fact  that  certain  error  component*  and  dynamic  Interactions  tend 
to  dominate  the  error  benavior  in  the  system  outputs,  This  spproaoh  of  simplifying  the  error  model  to  reduoe 
the  computational  requirements  is  important,  because  it  enable*  the  tnelyat  to  use  hi*  experience  directly  In 
determining  the  error  controller  design. 

S.t  •implifltd  Linear  Error  Controller  Synthesis  *nd  Evaluation 

Rinoe  thr error  model  pltya  the  central  role  In  the  Kalman  linear  error  controller,  it*  simplification  yields 
a  natural  aethod  of  reducing  the  controller  complexity.  Generally,  tha  idea  le  to  retain  the  more  dominant 

•tat*  variables  and  their  dynamic  interaction  to  define  a  slimier  error  model.  To  be  specific,  three  steps  are 

Involved  in  this  design  einpliflcstlon,  The  firgt  step  is  to  reduce  the  dimension  of  the  refined  error  model  by 
deleting  those  components  of  the  error  state  vector  which  ars  felt  to  contribute  leist  to  overall  error  in  the 
usable  system  outputs.  The  second  step  is  to  eliminate  dynamic  inter-couplings  between  these  rstelned  stete 
variables' shlch  contribute  least  to  the  definition  of  their  behavior.  These  two  steps  amount  to  obtaining 
simplified  differential  equations  describing  the  more  dominant  Itata  variables  Df  tha  original  error  model,  Once 
tbeaa  steps  are  accomplished,  refinement  of  the  proposed  filter  'based  on  the  simplified  error  model  1*  made. 

■This  final  step  of  refinement  involve*  the  adjustment  of  white  noise  observation  or  disturbance  noise  parameters. 
The**  psraasters  ere  selected  so  sa  to.  compensate  to  some  extent  for  the  simplifications  made  in  the  preceding 
■tape. 

To  determine  whether  an  error  model  simplification  or  parameter  adjustment  is  appropriate,  the  effect  on 
overall  system  performance  oust  be  ascertained.  Slnoe  the  system*  considered  in  navigation  applications  ere 
highly  complex,  little  progress  in  making  such  dettraUnatlons  can  be  made  in  a  simple  way  analytically. 
Consequently,  digital  oomputer  programs  which  provldi  cither  simulation  results  or  solutions  to  complex  arrays 

of  analytical  equations  must  be  employed  in  studying  such  systems.  For  general  system  studies,  Monte  Carlo 

liaulatlon  programs  have  been  applied  with  euooeii.  Usually,  however,  in  tpplylng  suoh  programs  a  large 
number  of  runs  aust  be  aada  to  obtain  preclia  results.  Precision  la  required  in  this  synthesis  problem,  ts  the 
exact  statistical  effect  on  eyetem  performance  due  to  a  design  change  must  be  known  for  design  decisions  to  be 
aade. 

For  the  case  in  which  an  adequate  representation  of  the  system  ctn  be  obtained  from  a  linear  trror  modal,  the 
following  spproaoh'  hat  proved  useful  in  determining  linear  controller  designs  which  are  simpler  than  the 
optimal.  This  technique  will  be  tilocusied  for  the  design  of  e  Kalian  error  controller  based  on  a  simpler  error 
eodel  of  the  system  than  the  reference  error  model.  The  Kalman  error  controller  impacts  on  tha  system  error 
propagation  at  update  tlaas,  whioh  occur  when  a  reliable  oomparlion  of  data  derived  from  any  two  indapandent 
sensors  can  be  made  and  tha  system  computer  hes  sufficient  time  to  perform  all  computations  required  for  updating. 
Retwean  tha  update  instants,  all  eyetem  errors  propagate  fraely  from  the  initial  values  resulting  after  tha  most 
recent  ays tee  update.  Between  the  eyetem  correction  times  we  assume  that  the  actual  system  error  behavior  1* 
described  by  tha  linear  vaotor  differential  equation 


Aft)X(t)  +  «(t)  . 


x(t)  Is  in  n-dimeoeional  recto*  describing  all  system  errors  which  have  initial  values  detorlbsd  by  the 
covariance  matrix: 

Z,  l[*f0)xx(0)J  ; 

Aft.)  la  an  n  >  a  matrix  dtfining  the  lioaar  dynamic*  of  the  errors  in  the  refined  or  reference  error  model; 
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«(t)  1*  >  zero-mean,  whits  noli*  process.  where 

Qft)S(t  -  T)  4  E[«(t)X«(T)]  , 


With  thla  notation,  a  well-known  equation’  describing  the  propagation  of  the  covariance  matrix  corresponding 
to  th*  system  error  xft)  la 


Aft)X(t)  V  X(t)AT't)  +  Qft)  . 


(5.21 


Whenever  an  update  is  to  be  made,  it  le  assumed  that  the  comparison  of  data  from  different  sensors  results  in  a 
linear  combination  of  the  errors  x(t)  ,  plus  an  additive  white  noise  component,  Thus  the  error  which  is  actually 
observed  is  defined,  in  terms  of  the  variables  denoted  bolow, 

y(t)  4  H(t)xft)  +  fi(t)  ,  (5.31 


where 

y(t)  le  the  m-dimenslonal  error  difference  which  ie  actually  observed; 

H (t)  ll  it  ■  i  n  matrix  describing  tho  linear  inter-relationship  of  the  n-error  components  of  x(t)  entering 
into  the  obaervstion  srror: 
tj( t)  is  e  zero-mean,  white  noise  process,  whare 

•  R(t)S(t  -  T1  4  |[<(t»<e (t)]  . 

when  an  update  le  executed,  an  n  x  m  gain  matrix,  K(ti  ,  la  used  to  weight  the  vector,  y(t)  ,  to  form  a 
oorraotlon  vector,  o(t)  .  Thla  ie  then  introduced  into  the  system  to  result  in  the  following  ohange  in  the 
current  system  error; 

**<»r  »  *■<>!  -  o<ti  ,•  (5.4} 


where 

x~'*(t}  is  the  current  system  error  before  and  after  tlie  update  is  made,  respectively; 

o(t)  4  K(t)y(t.)  le  an  n-dlmanaional  correction  vector; 

K(t)  le  the  n  »  ■  gain  matrix  used  to  weight  the  obierved  error  differenoe,  y(t)  , 

The  tranaltlon  of  the  oovarianoe  matrix  describing  system  error  upon  update  ie  given  by  the  well-known  equation 
^(t)  «  [l  -  K(t}H(t)]X*(t)[l  -  K(t)H(t)]r  +  K(t)R(t)K(t)T  ,  (5.5) 

where  £"<*(t>  la  the  covariance  matrix  before  and  after  update,  reapeotlvely, 

For  that  ous  In  which  the  optimal  linear  oontroller  with  reapeet  to  the  error  model  le  Implemented,  the 
optlaal  gain  la  given  by  tha  wail -known  equation1 

K*(t)  =  X*(t)H(t)T[H<t)X-<t)H(t}T  +  Rft)]'1  ,  (5.8} 

The  uae  of  the  optlaal  gain  K*(t}  ,  allowa  Equation  (5,5)  to  ba  written  in  the  simplified  form 

X*(t)  =  Cl  -  K*(t)H(t)]X-(t)  .  (5.7) 

Our  Interest  here  la  not  tha  use  of  this  optimal  mechanization,  but  rather  ons  which  is  lee*  complex,  whare  the 
reduction  In  complexity  results  from  a  direct  examination  of  the  system  arror  in  Equation  (8.1).  With  this 
approach,  the  analyst  first  examines  th*  error  vsotor  x(t)  ,  and  deletes  those  component*  which  he  feels 
oontribut*  in  a  relatively  minor  wty  to  total  arror  in  tha  system  applicetion.  Once  thli  le  done,  a  new  error 
reotor  Ift)  ,  of  reduced  dimeoeion  ft,  a  <  5  <  n  -,  le  obtained.  The  analysis  then  examines  the  subset  of  elemsnte 
of  the  error  dynamics  matrix  A(t)  ,  which  describe  the  interaction  of  the  error  component*  in  Xft)  ,  Elements 
of  this  abbreviated  portion  of  tbs  matrix  Aft)  cot’  felt  to  dseerlbe  significant  interaction  of  the  components 
of  Xft)  are  then  eliminated.  A  new  dynaalo  eatrix  Aft)  ,  of  diaenelon  B  x  B  ,  can  then  be  formed  of  th* 
retsined  element*  of  Aft)  Th*  next  step. is  to  determine  whether  the  disturbance  whit*  noise  prooess,  eft)  , 
might  be  modified  to  aid  in  deaorlblng  the  actual  system  error  propagation.  Usually  an  increase  in  tb*  magni¬ 
tude*  of  th*  retelned  shit*  noise  components  la  bensflaitl,  in  that  additional  uncertainty  la  artificially 
Introduced  into  the  simpler  error  model,  oompsoittlng  to  ecmi  extent  for  the  reduction  in  uncertainty  that  ie 
associated  with  th*  elimination  of  error  component*  in  obtaining  Xft)  from  ift)  ,  Th*  final  result  is  then 
a  simpler  error  eodel  described  by 

2"  M  »  *<t)tft)  +  Sft)  ,  (5.8) 

at 

where 

Eft)  is  the  B-dlmegelonal  error  vector  (m  <  i(i); 

Ift)  is  th*  lit  dimensional  dynamics  matrix  for  the  vector  Ift); 

Wft)  ie  *n  B-dimedilonal  zero-mein,  whits  noise  process,  where 
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4(t)S(t  -  T)  a  E[?(t)><»(T)]  , 

Clearly,  th*  (quit ion  dasorlblng  th*  propagation  of  tt)«  oovarianc*  matrix  eorraaponding  to  Equation  (8,8)  1> 

~  [2  =  +  E(t)*<t>r  +  $(t)  .  (8.8) 

at 

Th*  description  of  th*  obiorvitlon  prootti  rr  citing  fron_th*  use  of  th*  trror  «odel  In  Equation  (8,8)  It 
oacesssrlly  ohanitd,  Th*  simplified  obmrvntion  matrix  H(t)  it  obtained  by  inelutling  only  thoae  elements  In 
H(t)  involvlne  th*  error  oompon*ntl‘  rotalnad  In  K(t)  .  Again  to  oompenaat*  th*  reduction  In  the  uncertainty 
due  to  elimination  of  error  vector  component*,  th*  whit*  noiai  proem,  rj(t)  ,  might  be  modified  in  obtaining 
a  model  of  obaerved  error,  Ae  waa  done  In  the  oaae  of  th*  dieturbano*  noiae  pruoeaa,  the  magnitude*  of  the 
obeervatlon  noli*  component*  are  usually  assumed  larger  to  introduce,  artificially,  uncertainty  Into  the 
datorlptlon  of  the  tlmpler  modol,  The  final  result  la  a  representation  of  the  error  actually  observed  in  term* 
of  the  variables  denoted  below: 

r(t)  4  B(t)T(t)  +fj(t)  ,  (8.10) 

where 

y(t)  ia  tha  actual  m-dlmensional  obaarvation  vector; 

R(t)  ia  an  (a  *  8)  matrix  apaoifylng  tha  ralationahip  daatrad  batwaan  ooaponanta  of  the  error  veotor  l(t); 

f)(t)  ia  *  sero-mean,  m-dlmenaional  white  nciaa  prooaaa  deaorlbing  additive  nolaa  in  tha  obaervtd  error* 

(•ft),  where 

*b)(t)*»)<T)]  £  K(t)S(t  -  r>  . 

*  • 

If  Kalman*  a  algorithm  for  tha  computation  of  th*  lain  matrix  la  now  employed: 

K(t)*  a  2(t)B(t)TCHft)?(t)‘ii(t)T  +  R]-1  ,  (b. li) 

and  used  to  weight  tha  actual  obaervtd  error,  tha  sorraotion  obtained  for  tha  aimpllfled  error  model  at  update  la 

**<t)  »  V<t)  -C(t>  .  (8.  IS) 

where  f-*(t)  la  tha  modeled  system  error  before  and  eftar  update,  rtapeotively,  and  B(t)  *  R*(t)y(t)  ia  tha 
florrectlon  veotor.  Tha  tranmitiou  qT tha  covariance  matrix  oorratpondini  to  tha  aimpllfled  error  modal  la 
expraaead  from  Equation  (8.13)  aa 

2(t>*  »  [l -  R\t)H(t)]S(t)*  .  (8.13) 

How  that  tha  technical  detail*  have  baen  preaantad,  a  review  it  in  order,  flret,  by  aaaumptlon,  tha  analyat 
hat  baan  given  a  couplax  Unaar  modal,  daflnlnl  error  propagation  In  Equation  (8.1),  and  th*  obetrved  arrora  in 
Equation  (8.3),  for  aoma  eyatem.  The  objaetiva  ia  to  dealgn  an  trror  controller  which,  while  having  tha  atatl- 
•tlcal  correlation  attribute*  of  Kalian  theory,  ha*  a  laaaar  computational  burdan  than  that  impllad  by  th* 
optlaal  aaohanisatlon.  Th*  optimal  seohanization  raquiraa  tha  uat  of  Equation*  (8.2),  (8.8),  (B.8)  and  (5,7). 

Th*  choice  of  approaoh  involve*  th*  examination  of  th*  complex  error  modal  to  determine  what  aimplifloatloni 
can  b*  introduoad  Into  Equation  (5.1)  emd  their  Impact  on  Equation  15.3).  Th*  reaulti  are  the  simplified 
axpraaalooa  (8.8)  and  (8,10).  from  that*  equation*  a  Ian  oomplax  Kalman  mechanization  la  impllad,  which  would 
b*  implemented  with  Equation*  (8.8)  and  (8. 11)-(S.  13). 

Olaarly,  th*  ilap.'tr  trror  controller  rtaliaaa  poorer  performance  than  that  achieved  with  a  mechanization 
based  on  tha  oomplat*  error  modal.  However,  the  performance  loss  Incurred  by  uelng  th*  simpler  mechanization 
might  be  inzlgnlfloant  in  tares  of  tb*  performance  required  of  th*  ayatem.  Th*  question  of  praotlcal  importance 
which  rtealnt  la  that  of  datarming  tha  performance  loaa.  Th*  method  by  which  this  question  is  answered  la  also 
th*  manner  by  which  th*  analyat  will  taat  tha  validity  of  tha  varloua  amplification*  and  alterations  of  th* 
original  error  model  that  are  mad*. 

Tb*  method  by  which  the  answer*  to  these  question!  ar*  obtained  ia  quit*  simple.  First  th*  ultimata  perfor¬ 
mance  obtainable  ia  determined  by  propagating  the  covariance  astrix  X(t)  ,  mini  Equation  (8.3),  with  optimal 
updating  through  the  uae  of  Equations  (8,8)  and  ,5.7).  The  solution  for  E(t)  .  denoted  X^t)  ,  and,  in 
particular,  for  th*  dingonal  element*  or  error  variances  then  aervee  as  th*  reference  against  which  performance 
obtained  with  any  otbar  mechanization  can  ba  compared.  The  aicond  itep  involve*  th*  propagation  of  the  two 
oorarlanc*  mstrioa*  X(t)  and  Eft)  .  Z(t)  la  maaln  propagated  uilng  Equetlon  (5.3),  while  Set)  ia  propagated 
by  Equation  (5.9).  At  the  updata  lnatanta,  tha  gain  K*(t)  ,  uelng  Equation  (5.11),  la  computed  and  uatd  in 
Equation  (5.13)  to  update  £(t)  .  To  determine  the  effact  of  using  K*(t)  ,  which  is  sub-optiail  coopered  to 
K*(t)  obtslnad  by  Equation  (8.8)  on  th*  aotual  system  error*,  sn  (n  <  m)  matrix  K (t )  is  defined  by 
augmenting  K(t)  suitably  with  zeros.  Then  f(t)  is  employed  in  Equation  (8.8),  which  desoribes  th*  effect 
on  th*  actual  aystam  error  oovarlano*  matrix’  that;  results  from  the  us*  of  an  arbitrary  gain  matrix.  Compan¬ 
ion  of  tba  solution  for  X(t)  ,  denoted  a*  Z(;t)  and  determined  in  the  second  step,  with  th*  reference 
solution  Z|,(t)  ,  obtained  in  th*  first  step,  then  indicates  the  degree  of  performance  degradation  that  reeuits 
through  the  use  of  the  proposed  oomcutationally-leis  burdensome  mechanization. 
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Than  la  a  significant  lnorsut  In  coat  of  th«  computer  snelyiis  with  tin  Inoreeee  In  the  dimension  of  tha 
rafaranca  nodal  in  tha  aynthaiia  approach  daacrlbad,  Tharafora,  tha  analyst  imat  often  make  certain  tpproxl* 
astioni  avan  In  tha  rafaranca  arror  modal.  To  obtain  t  suitable'  rofecwH  modal  of  manageable  dlmenrlo.i,  multiple 
aouroas  of  arror  which  antar  the  system  at  tha  samo  point  can  ba  merged  and  represeritid  as  ainsla  nolae  error, 

To  maintain  tha  Intairity  of  tha  design  results,  tho  statistical  characteristic's  of  this  lumped  noise  source  can 
he  selected  to  more  than  account  for  the  multiple  sourcos  of  error  represented.  For  example,  in  the  desigh  of 
augmented  inertial  cavitation  systems,  a  finely-detailed  struoture  oan  bo  dovalopad  to  model  the  error  in  the 
accelerometer  measurements  or  the  stability  of  the  iyro  orientation.  Upon  examining  this  detailed  error  structure 
and  considering  the  anvironment  In  which  the  instrument  oust  operate,  the  enalyst  can  represent  these  errors  as 
aingls  aourees  of  first-order  correlated  noise.  With  these  assumptions  used  to  obtain  a  simple  stochastic  gyro 
drift  rate  or  aooeleromster  talas  shift,  the  syntheala  touhiiiijue  daacrlbad  could  then  ba  naed  to  determine 
precisely  tha  relationships  between  propoaed  design  innovations  and  the  system  performance. 

Once  a  navigation  system  error  controller  is  derived  with  this  technique,  acme  question  might  sxlst  an  to  the 
validity  of  tha  assumptions  made  in  using  slmpls  descriptions  of  tha  lnartlal  Instruments.  This  question  can 
noa  ba  addressed  in  s  meaningful  manner  by  employing  t  Monte  Carlo  program  to  simulate  the  system  using  refined 
error  models  and  tha  newly-derived  error  controller.  Accepting  the  imprecision  of  results  obtainable  with  a 
ftw  trials  using  tha  Manta  Carlo  program,  gross  deviations  from  expected  system  performance  can  bo  adequately 
Identified  at  a  reasonable  coat. 

In  summarizing  chla  notion,  g  gtraightforward  application  of  Kalman  theory  to  augmantad  lnartlal  navigation 
lyatem  design  using  all  information  about  tha  aanaor  arror  sharaotarlstloa  cin  result  In  a  design  whloh  la 
Impractical  In  tarns  of  the  requirements  lmposad  on  tha  system  digital  computer,  A  method  of  obtaining  an  arror 
oontrol  mechanization  which  has  tha  desirable  correlation  property  of  a  Kalman  filter  waa  described  in  detail, 

This  approach  ia  direct  in  tha  same  that  it  daali  with  the  oharaotnr  of  the  modalad  arror  characteristics  of  the 
sensors,  A  digital  computation  procedure  waa  outlined  whereby  this  aynthaiii  approach  oould  ha  utilised  in 
designing  error  controlleri  for  complex  systems.  This  procedure  has  bean  used  in  tha  avionics  ayatsms  Industry, 
particularly  In  obtaining  tha  augmented  lnartlal  navigation  system  error  oontrol  mechanization  desorlbsd  In 
Section  T.  • 


I.  IMPLEMENTATION  OF  KALMAN  EKROR  CONTROLLERS  IN  AUGMENTED  INERTIAL  NAVIGATION  SYSTEMS 
I,  I  Oenerel 

In  a  previous  seation,  practical  consideration!  influencing  tha  implementation  of  a  Kalman  error  controller 
in  an  eugnentad  lnartlal  navigation  system  were  dlicuseed.  We  now  consider  the  detailed  operations  whloh  are 
Implemented  to  mechanize  the  derived  error  controller  In  tha  system  digital  computer.  Whan  tha  synthesis  of 
tha  Kalman  oontrollar  ia  completed,  tho  design  error  model  for  the  ayetem  la  described  by  tha  following  linear 
differential  equation,  whloh  la  represented  aohematloally  in  tha  block  diagram  of  Figure  8: 

[J(t)]  »  A(t)*(t>  +  I(t)  ,  (0.1) 

at 

In  augmented  inertial  navigation  eyatemi,  measurements  are  msds  it  discrete  instants  of  time  end  oompared 
with  estimates  of  their  vtluee  computed  from  the  eystsm  navigation  variables,  For  sufficiently  small  errors, 
the  dlffepmoe  of  the  measurement  end  the  predicted  value  can  be  represented  as  s  linear  combination  of  error 
atetas.  TMs  difference  le  called  the  observation  arror  and  ia  wrlttan 

y(tt)  =  +  l)(tj)  .  (0.3) 

Whan  a  measurement  la  made  tha  observation  arror  la  multiplied  by  a  Kalman-derived  gain  matrix  to  form  a 
oorraotion  vector  to  updata  the  system: 

«(»!>  =  (Kt^ydj)  .  (0.3) 

Tha  updated  value  of  the  modeled  error  state  veotor  of  the  eyetem  le  expressed  by 

Kt,)*  *  I(tt)-  -  0(t,>  .  (0.4) 

When  oarriotlonx  are  used  to  alter  tha  valuta  of  the  navigation  variables  within  the  lyiten,  servo-msuhaniem 
oontrol  at  the  modeled  errors  le  realized.  The  implications  of  suoh  a  mechanization  as  opposed  to  the  formal 
la lain  filter  leplensntatla.  ere  noted  later. 

A  description  cl  cho  error  bthavlor  of  tha  ayatem  for  tha  operations  defined  above  oen  be  represented 
aohenatlraiU  hy  the  block  diagram  shown  in  Figure  7.  This  diagram  is  analogous  to  that  for  a  servo-mechanism 
whJc  etternig  fo  nojl  ‘ha  system  outputs  by  feeding  linear  combinations  of  these  outputs  baok  through  the 
gala,  i  .  K.  'ihwory  contributes  to  error  controller  design  primarily  through  the  algorithm  used  to 
obti.  ..no  r .  •  at -u.  The  gala  matrix  obtained  with  Kalman  theory  takes  oognizince  of  the  statistical  state 
of  a.  •  U  ..U.n  a-,  represented  by  ths  cover lsnoe  aatrlx  and  tha  quality  and  type  of  obaarvation  available. 

An  th«  .  _■  «r  etate  veotor  ohaagei  with  time  between  the  ayatem  correction  instants  as  described  by 
Equation  '■  i  ■.  covariances  of  these  error  states  also  change.  These  changes  In  the  statistical  state  of 


a-n 


the  tyttin  error  oan  bo  determined  in  real-time  through  the  propagation  of  the  eyetem  error  covariance  matrix, 
Alternato  method!  have  been  derived  for  performing  the  computet  lone  required  for  propagating  thin  information. 

Theme  methods  include  direct  integration  of  the  differential  equation  for  the  oovarlenoee  end  diecrote  prope- 
gation  through  use  of  the  trinsition  matrix.  Other  achemen*  deal  with  root  mean  square  values  rather  than  the 
varlenoea  of  the  errors  to  reduce  the  precision  requirements  In  ths  digital  computation,  tn  any  oaso,  the 
particular  application  under  consideration  and  the  equipment  aval  labia  for  system  implementation  will  determtno 
which  of  theee  computational  techniques  is  tho  most  advantageous  to  employ.  When  a  measurement  Is  made  with  a 
sensor,  the  correction  of  the  system  require*  ths  computation  of  the  gain  matrix.  When  a  eystem  oorrection  is 
made,  changes  occur  in  the  statistical  inter-relationships  bat -sen  the  error  state  variables.  At  the  update 
time  the  covariance  matrix  elements  srs  titered  to  reflect  ths  fiot  that  the  system  oorrsotion  was  made, 

A  review  of  thn  above  paragraphs  oonoludes  that  the  following  basic  operations  muet  be  implemented  In  ths 
system  digital  oomputer  to  accomplish  the  mechanisation  of  a  Kalman  error  controller: 

1.  Propagation  of  covariance  matrix  variables  between  instants  of  time  at  which  measurements  are  made. 

2.  Selection  end  enmpling  of  the  measurement  date  tn  be  proooaasri  at  tho  aystem  update  time. 

3.  Computation,  basod  on  the  valuen  of  eyatcio  variables  at  the  update  time,  of  predicted  values  for  the 
seleoted  measurements  and  formation  of  the  differences  of  those  predictions  with  the  actual  measurement 
data  to  obtain  observed  errors. 

4.  Computation  of  ths  Kslatn  gain  matrix,  Used  on  oovsrlsnos  matrix  values  at  the  update  time  and  tha  type 
and  quality  of  ths  msssurament  data. 

8.  Weighting  of  ths  observed  error  with  the  Kalman  gain  matrix  to  obtain  the  correction  term  uatd  to  updata 
the  system  variables  whose  errore  are  represented  in  the  design  error  model. 

«.  Updating  of  the  covariance  varlablaa  at  tha  updata  time  to  raflaot  tha  axaoutlon  of  tha  ayatan  correction. 
The  logloal  relationship  of  these  basic  operaticaa  la  summarized  schematically  in  Figure  a. 

8. a  Error  Controller  Configurations 

Two  major  approaches  have  been  proposed  for  tha  configuration  of  tha  error  control  maohanlam.  In  tha  first 
and  moat  popular  approach,  the  ayaten  correction  vsotor  determined  at  a  measurement  tine  la  used  to  update  values 
of  tha  navigation  variables  and  to  bias  noise  sources  within  the  eyatem.  This  la  tha  basic  feedback  scheme 
already  dlaausaad.  In  the  eacond  approach,  only  tha  ayatam  outputs  are  corrected  ualni  tha  valuan  of  propagated 
aatlmatsa  of  the  system  errors, 

8.3  feedback  Correction 

In  tha  faedbaok  oorrection  scheme,  tha  ayatam  la  organized  schematically  as  shown  In  Flgura  9.  Hers  corrections, 
are  mads  to  those  errors  in  aaah  subsystem  which  are  included  in  the  daalgn  trror  modal,  Tha  faadbaok  of  tbs 
oorractlona  derived  by  weighting  tha  observed  error  with  the  Kalaian  gain  matrix  baa  two  advantacaa.  Since  the 
Kalman  controller  le  based  on  a  linear  error  model  of  the  system,  any  process  which  kaapa  this  assumption  valid  - 
la  advantageous.  Since  proper  feedbaok  oorrection  will  tend  to  deorsaee  error  within  the  system.  It  la  advanta¬ 
geous  to  maintain  tha  linearity  easumptlon  made  for  the  behavior  of  the  errors.  Clessloalljr,  faadbaok  hat  bean 
used  to  neutralize  automatically  tha  effact  of  variations  within  a  ayatem.  This  inssnwltivlty  property  Inherent 
to  faedbaok  cyatama  leads  to  tha  saoond  advantage  in  employing  the  servo-mechanism  tpproaoh.  Tha  mors  error 
atatea  which  are  included  in  the  design  error  modal,  tha  batter  should  bs  tha  pirforeanoa  obtained  by  the  ayatem. 
However,  the  beela  insensitivity  realized  by  feedback  to  tha  ayatam  variations  implies  that  tha  effect  of  many 
sources  of  error  will  automatically  be  reduced  even  when  they  are  not  lnoluded  in  tha  design  error  modol. 

6.4  Output  Correction 

In  tha  output  correction  soheae,  tha  ayataz  la  organized  schematically  as  shown  In  Flgura  10.  Hera  no  direct 
oorractlona  are  made  to  teamed  sources  of  arror  in  the  subsystems.  Tha  linear  arror  nodal  aquations  for  tha 
ayatam  art  used  to  propagate  tha  arror  stats  vector  estimate.  A  oorrsotion  vector  it  than  derived  as  s  linear 
transformation  of  ths  propagated  error  vector  and  uatd  to  update  only  the  ayatam  outputs. 

Tha  chief  disadvantage  of  such  an  approach  la  that  arror  ia  introduced  through  imperfect  modeling.  This  oocura 
through  two  affeotw,  Since  error  in  the  system  la  not  corrected  toward  the  null,  aa  with  tha  faedbaok  method, 
tha  easumptlon  of  linearity  can  beoome  Invalid,  Alao,  the  insensitivity  characteristic  of  tha  faedbaok  schema 
la  lost.  Consequently,  a  higher-dimensional  linear  error  model  will  probably  havt  to  be  employed  aa  a  beats  of 
tbs  Kalman  filter  to  obtain  performance  comparable  with  that  obtained  using  ths  feedback  scheme.  Another  dis¬ 
advantage  of  this  approach  la  that  an  eatimmte  of  the  modeled  system  error  states  must  be  propagated.  Thla  la 
avoided  in  tha  feedback  mechanization.  An  advantage  of  tbia  approaoh  ia  that  improper  updates  raaulting  from 
undetected  spurious  subsystem  operation  will  affeot  only  the  outputs,  Id  tha  feedbaok  method  an  improper  update 
oan  drive  a  subsystem  to  an  Improper  operating  region,  resulting  in  a  loss  of  overs' 1  ayatem  performance. 

However,  such  behavior  oan  be  avoided  In  the  feedbaok  method  by  developing  effective  oheoks  on  subsystem  operation 
and  tha  measured  arror  difference, 


7,  A  KALMAN  ERROR  CONTROLLER  DF.SION  FOR  MULTI  ■  SENSOR  AUGMENTED  INERTIAL  NAVIGATION  SYSTEMS 


7.1  Otneral 

Th«  Doppler  radar,  eetro-treoker,  1,0 RAN  receiver  and  Inertial  platform  ara  raprasantatlvaa  of  different  claaiai 
of  navigation  aaneora  having  complementary  oharaotcriatioa  which  oan  be  employed  to  advantage  In  an  Integrated 
navigation  system,  The  autonomous  and  conventional  Integrated  operation  of  thaae  aenaora  has  boon  discussed, 

The  Doppler-inertial,  astro-lnertlal  and  LORAN-lnertial -navigation  modes  are  ro-etamlned  below,  using  the  more 
aophletloated  Kalman  linear  oorrolation  theory  for  msru  optimal  mixing  of  the  sensor  data.  Tho  mechanization 
obtained  is  suitable  for  implementing  any  combination  of  the  foregoing  modes,  inoluding  the  fully-integrated 
astro-OoppU'r- inert  1«1 -I, ORAN  navigation  mode. 

As  previously  noted,  a  straightforward  application  of  Kalman  theory  may  not  be  desirable  or  necessary  in 
obtaining  a  navigation  system  trror  control  mechanization:  not  deairsble,  owing  to  the  magnitude  of  the  computer 
requirements  implied  for  an  implementation  based  on  a  detailed  error  model  of  each  sensor;  not  neceaaary,  as  tha 
mission  to  which  the  system  ia  to  be  applied  may  not  warrant  a  hlghly-oomplox  mechanization.  A  thorough  examlnn- 
tlon  of  the  navigation  aystem  requirements  generated  by  the  intended  mission  must  he  mads  if  the  resulting 
design  is  to  be  cost-effective. 

The  mission  considered  in  synthesizing  the  navigstion  ayatem  of  this  suction  is  termed  fost-reaotlon,  meaning 
that  aoourata  value*  of  vehlolt  position,  velocity  and  attitude  are  desired  within  a  short  period  of  time  after 
the  system  le  eotiveted.  In  this  mission  no  operational  restrictions  on  the  vehicle  should  mult  from  any 
charactariatlo  of  the  navigation  ayatem  operation.  For  this  miaalon  tha  aystam  arror  control  mechanisation 
described  below  was  derived  using  synthesis  procedure  described  in  Seotlon  S.  The  performance  of  tha  navigation 
aystam,  lmpleiiented  with  tha  derived  Kalman  mechanization,  ia  illustrated  for  the  faat-reeotion  mission  in  the 
prinolpal  integrated  modes  of  operation. 

T, I  Derivation  of  the  Kslaan  Mechanisation 

Tha  straightforward  application  of  Kalman  thaory  to  a  detailed  error  model  of  an  aatro-Doppler-lnartial-LORAN 
aystam  could  easily  involve  computations  dealing  with  fifty  or  more  error  state  variables  having  quite  oomplex 
dynamic  interactions.  If  a  Kalman  mechanization  war*  baaed  on  auoh  a  modal,  corrections  would  be  obtained  for 
tha  aocountad  aourcas  of  equipment  and  environmental  error,  as  well  as  tha  aystam'  a  navigation  outputs.  In 
addition,  through  a  datailad  description  of  the  dynimlo  interaction  of  varlablss,  arror  propagation  over  the 
long-term  would  be  accurately  predioted. 

An  examination  of  tha  application  of  tha  navigation  aystam  to  mast  the  requirements  of  tha  faat-reaotlon  miaalon 
raaulta  in  the  primary  requirement  that  the  inertial  platform  be  rapidly  aligned  regerdlaas  of  tha  operational 
environment,  Rapid  platform  alignmant  1*  neoesaary  at  tha  mission  requires  dynamically  accurst!  attitude  and 
valoolty  Information,  whloh  art  natural  output!  only  of  the  inertial  ayatem.  Acourata  valuta  of  thssa  varlablss 
will  not  ba  available  until  platform  allgnnent  la  achieved.  If  platform  alignment  end  oontrol  of  poeltioi  and 
valoolty  errors  ara  th*  prinolpal  objectives  of  tha  Kalman  arror  uontrol  mechanization,  it  remains  only  to 
datarnina  whloh  or  tha  aystam  arrora  and  intarastlona  has  especial  Importance  in  maetlng  this  objective.  Since 
petition,  velocity  and  attitude  are  the  required  ayatem  outputs,  Lt  la  clear  that  arrora  in  thus  variables 
aunt  ba  controlled,  Clearly  than,  a  minimal  mechanization  would  Incorporate  at  least  th*  arrora  In  that*  vari¬ 
ables  at  components  of  the  stale  veotor  of  the  simple  error  model. 

Platform  alignment  le  essentially  a  procaaa  of  aUninatlng  high  Initial  valuta  of  attitude  trror  and  any  error 
In  aomputad  velocity  or  position  occurring  si  s  result  of  attitude  trror.  The  exletenoe  in  the  syetem  error 
model  of  biesei  or  noise  touroei  associated  with  equipment  or  induced  by  the  environment  will  then  only  be 
relevant  if  auoh  aouroei  eerlouily  affect  alignment,  The  optimal  control  of  arrora  resulting  from  itoohsstlo 
Inputs  to  a  system  it  usually  a  problem  whloh  ocuuri  more  often  in  the  mteady-etate.  In  navigation  myitems,  tuoh 
trror  oontrol  is  of  Importance  in  applications  Involving  long-term  orulie  mission*  requiring  extremely  high  navi¬ 
gation  aocuraoy.  Foi  th*  alignment  application,  many  auoh  sources  are  not  likely  to  be  very  Important  end 
consequently,  can  be  eliminated  In  the  elmple  error  model.  It  will  be  recalled  that  tha  loss  In  uncertainty, 
rtaultlng  from  an  elimination  of  these  verlablts  from  the  error  model,  can  be  partially  accounted  for  by  arti¬ 
ficially  Increasing  the  ventnoes  of  sppropriite  white  noise  souross  In  the  simple  model.  However,  exceptions  to 
this  philosophy  txist,  Thtaa  exception*  can  occur  when  the  error  in  quiatlon  ie  a  long-term  noise  whloh  oonatl- 
tutea  a  significant  fraction  of  the  different*  between  a  measurement  value  and  th*  prediction  of  that  value 
during  platform  alignmant.  When  this  situation  exists,  tha  modeling  error,  resulting  from  an  exclusion  of  the 
ooist  eouroa  In  question,  can  oeuse  e  signifloent  loss  in  system  performance  which  cannot  be  offset  by  white  noise 
parameter  adjustments.  One  oere  of  this  sort  ooours  during  gyro  compassing  of  the  inertial  platform  with  Doppler 
speed  date  oontalulng  large  bleees,  Another  example  is  afforded  by  ths  oast  in  which  there  exists  signifloent 
distortion  of  the  eotuel  electronic  LORAN  time  difference  grid  from  the  theoretical  grid  baud  on  gaodatio  data. 
Tbit  distortion  le  caused  by  variations  In  tha  proposition  speed  of  tha  eleotromagnatlo  energy  over  tho  earth's 
aurfaca  resulting  from  unaccounted  variations  in  the  nature  of  the  paths  of  propagation. 

In  addition  to  the  tUmlnatlon  of  most  noise  sources  in  the  alignment  application,  dynamic  Interactions 
between  the  retained,  error  state  veritblee  can  be  reduced  to  e  minimum  by  elimiosting  those  defining  error 
propagation  characteristics  which  are  long-term  with  reepect  to  the  fest-reeotlon  mission.  Suoh  couplings 
are  aiioolated  primarily,  with  tha  Inertial  senior  defining  the  characteristic  24-hour  oscillation*  end  modu¬ 
lating  Foucault  frequencies  which  are  present  in  s  detailed  error  model, 


7,9  Kalian  Krror  Controlltr  Description 


Aftwr  examining  a detailed  irror  model  of  the  navigation  system  and  the  requi remonta  of  the  fast-reaction  rlulon 
along  the  linos  outlined,  the  following  minimal  error  control  mechanisation  can  bo  derived,  This  mechanisation 
*111  Incur  only  a  small  loss  In  system  performance  during  platform  alignment,  If  relatively  accurate  aensora  are 
•mploysd  in  the  navigation  system.  The  meehanlnatlon  assumes  the  north-slave,  Bohuler-tunod  platform  Implementa¬ 
tion,  but  dsn  accommodate  any  local-level  platform  mechanisation  with  only  slight  modification.  It  is  s  minimal 
design  in  the  sense  that  only  the  errors  in  ths  required  system  outputs  srs  represented  in  the  simplified  error 
•tat*  vector,  consequently  reducing  the  model  dimension  to  s  minimum.  The  ssven  slsments  of  this  stats  vector  sro 


WliH  ars  the  angular  errors  In  system  computed  vehicle  position,  rspressnted  as  rotations  about  ths  local 
geographic  east  and  north  axes,  respectively; 

!VIiN  srs  th*  trrors  in  system  computed  vehicle  velocity  along  the  looal  north  tnd  asst  axes,  respectively; 

srs  tho  angular  errors  In  platform  attitude,  rapreaentad  as  rotations  about  the  local  east,  north  and 
vertical  axel,  reepaatlvsly,  The  east  and  north  components  art  usually  rtfsrrari  to  as  platform  tilts 
whlls  ths  third  component  la  oallsd  platform  azimuth  misalignment. 

The  matrix  defining  ths  dynamic  interaction  of  these  seven  trrer  state  variables  is 


This  astrlx  has  been  reduced  to  inoluda  only  those  terms  essential  to  alignment  followed  by  arulse  navigation 
for  s  thort  tins  period.  The  rssult  is  that  only  ten  of  the  elements  ars  non-sero,  Of  these,  four  era  Identical 
qpnatants  I'1  ,  I  being  s  nominal  radius  for  the  tsrth  and  four  ars  dtrlvad  froa  the  (pacific  foros  measure¬ 
ments,  Bt.  ,  and  SZp  ,  along  the  looal  east,  north  and  vertical  axss,  respectively.  The  final  two  elements 
tra  spatial  rats  tarns,  cu,0  ,  <^0  ,  being  tha  computed  ratal  at  which  tbt  platform  must  rotate  about  the  local 
mast  and  north  sxam,  respectively,  to  renaln  looally-levil,  dearly,  this  representation  of  insrtial  error 
behavior  is  such  simpler  than  that  described  in  Beotion  3. 

The  sero.-ieta,  white  disturbance  nolle  vector,  o.orreepondlng  to  Equation  (7,1),  can  lnoludt  up  to  atven 
oomponanta, 

he, 
h et 
fcv, 

*  ■  ?Jv,  .  (T.3> 


to  sacount  to  a  certain  extant  for  the  deletion  of  nolee  etste  variables  from  ths  detailed  syetom  error  model, 
The  vsrltnoe*  of  the  aleaente  N  z  are  of  principal  Importance  in  accounting  for  srrori  which  have  an 
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affect  on  tta«  platform  a*  dots  a  gyro  drift  rat*  about  the  corresponding  axle,  The  varlenoee  of  the  elements 
^SvN  ,  *ri  introduced  to  aooount  for  errors  which  have  a  etaohaatlo  effeot  on  the  veloolty  cwnputatlon  aa  does 
aooaieroffloter  noise,  quantization  error,  misalignment,  etc,  .Finally,. the  varlanoea  of  the  elenonte  £$g 
reflect  additional  uncertainty  In  the  poaltton  computation. 


N ,  I 


The  deaorlptlon  of  the  error  model  given  above  oorranponda  to  propagation  between  lnatentn  of  time  at  whioh 
ayetem  update*  are  made,  To  employ  Kalman'  a  algorithm  at  an  updata  time,  a  model  of  observation  error  must  be 
oonitruotsd.  In  an  aatro-Dopplor-inartlal-LOlUN  navigation  syatem,  the  measurements  that  onn  be  made  with  the 
sensors  whioh  augment  the  inortlal  aenaor  are  Doppler  ground  spaed,  Doppler  drift,  angle,  LORAN  tlme-dlfferenon(n), 
tracker  elevation  angle,  and  traoker  bearing  angle. 


When  one  of  theae  maasuromanta  la  made,  It  la  dlfftrencad  with  a  predicted  value  of  the  measurement  based  on 
the  oamputnd  values  of  the  system  navigation  variables.  If  the  associated  errors  are  sufficiently  small,  the 
aieaauriiient  diffebonoo  oan  be  represented  aa  a  linear  combination  of  the  errors  Involved.  The  ooofficlents  of  the 
error  terms  In  auoh  an  expression  era  simply  gradient  components  evaluated  at  thn  local  operating  point.  Blnoe 
noise  terms  aaaoolated  with  the  traoker, Doppler  and  1.0IWN  sensors  are  not  incorporated  In  the  simple  error  modul, 
the  observation  matrices  Involve  only  gradient  components  relative  to  the  errore  In  the  navlsation  variables. 

These  matrices  era  now  defined  for  the  different  aiaauramenta, 


The  vehicle  ground  speed  obiervation  aatrlz  la  expressed  aa 

HiVf  =  Co  o  ooa  9a  sin  e„  n  o  o!  ,  (7.4) 

whtra  6>0  la  vehlola  traok  angle  and  AVf  =  [vj0  -  V|0]  ,  danotaa  the  difference  between  computed,  V(0  ,  and 
Dopplar-aeaiurad,  V|D  ,  ground  apead. 

The  vehicle' drift  angle  observation  matrix  la  expressed  aa 

aln  8.  -co*  6. 


% 


0  0 


1  0  0 


(7.») 


'*«  ’go 

whara  AS  ^  [8#  ~  SD]  denote*  tha  dlffareno*  batwaan  aomputad,  SB  ,  and  Dopplar-maaaurad,  S„  ,  drift  angla. 
Tha  tiu-dlffarknoa  obasrvation  matrix  la  txpraaaad  aa 


j  (fain  4,  -  ala  /3t)„  (ooa  -  oo*  /3,)0  0  0  0  0  ol  ,  (7.8) 

share  B  era  the  computed  bearing  anil**  to  tha  DORAN  master  and  slave  stations  relative  to  the  local  north 
Una,  raapaotivaly,  C  la  tha  velocity  of  light,  and  At  §  [t„  -  tL]  danotaa  tha  difftrsnoa  between  computed, 
t0  ,  and  DORAN -at aaured,  tL  ,  time-difference. 


The  alavation  angla  obasrvation  matrix  la  axpraisad  as 

Us,  *  [sin  B„  -oo*  80  0  o  0  -min  Be  ooa  B,]  ,  (7.7) 

wber*  B0  la  tha  computed  star  bearing  angla  with  raapaot  to  tha  local  north  axis,  ind  Ae  ~  [kc  -  Ef]  danotaa 
tbt  dlffaranoa  of  oomputad,  ,  and  traoksr-saaaurad,  ET  ,  itar  alavation  angle. 


Th*  hearing  angle  observation  matrix  la  axpraisad  aa 

Ifa*  *  [(-ooa  B  tan  I  +  tan  4>)c  (-tin  8  ton  E),  0  0-1  (ooa  B  tan  E)e  (sin  B  tan  K)„]  ,  (7.8) 

whara  la  tha  oomputad  latltuda,  E  th*  oomputad  star  alavation  with  raapaot  to  tha  looal-lavai  plana,  and 
Ab  *  [b0  -  Bf]  danotaa  th*  dlffaranoa  batwaan  oomputad,  B,  ,  and  trackir-seisurtd,  BT  ,  blaring, 


Th*  final  aliments  of  th*  error  modal  to  be  defined  are  tha  aaro.mean,  additive  white  noia*  processes  associ¬ 
ated  with  aacb  of  th*  aaasurenant*  oitad  absva,  Aa  has  been  itated  previouely,  uncertainty  can  ba  artificially 
asioolatad  with  th*  obasrvation  procaaa  In  tha  simple  error  modal  by  Increasing  tha  varlanoaa  of  theae  note* 
components  fr  *  valuta  aaioolltad  with  tha  datallad  error  modal.  When  th*  eanaors  used  to  align  tha  Inertial 
platform  art  •  datively  aoeurate,  tha  oomponapti  dalatad  in  oonitruotlng  a  tlnpl*  error  modal  on  which  to  baaa 
th*  Kalman  maclionlaatlon  oan  ba  nooountej  for  adaquataly  by  this  method,  For  th*  above  ayatam,  tha  vaotor 
denoting  additive  whit*  obstrvttion  nolat  would  include: 


’hs 

ni* 


(7.9) 
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Thi  variances  of  tlio  elements  ^y«  V>  D>r*  used  to  aooount  for  noise  error  In  the  Dopplor  around  speed  and 
drift  angle  uoDnuramonta  which  very  'with  vehicle  (peed,  altitude,  attitude  and  terrain.  The  variance  of  the 
aliment  T^t  rspraeenta  LORAN-moesured  tlme-dlfference  holla  error,  which  vnrlta  with  dlatanca  from  the 
tranaaittini  etatlone,  local  inter f erence  and  eooia  anomallia  aiacolatari  with  the  path*  of  propagation,  finally, 
the  variance  of  the  eliiaente  account  for  nolai  error  Mandated  with  traokor  measurements  of  star, 

•lavation  and  bearing,  respectively,  which  vary  with  atar  brightness  and  atmnaphorlc  condition*. 


7.4  Description  or  a  Fast-Reaction  Mission 

He  nest  illustrate  the  relative  performance  achievable  in  the  different  navigation  modes  when  the  Kalman  feed¬ 
back  arror  controller  described  le  employed.  Thla  le  done  tor  a  nominal  faet-reaotlon  mission  for  which  this 
controller  wue  designed.  The  performance  of  the  system  for  the  imjol*  modes  of  navigation  le  discussed  in  detail 
later, 


The  vehicle  flight  dynamics  result  in  ths  profile  Indicated  schematically  In  Figure  11.  In  more  detail,  It 
was.eanumed  that  the  aircraft  spent  two  minutes  on  the  ground  after  the  Inertial  system  wan  activated.  Align¬ 
ment  of  the  platform  was  initiated  when  the  Inertial  system  was  aotlvutod,  The  Initial  r.m.s.  attitude  errurn 
of  tha  platform  ware  aasumedtoha  500  arc-aeconds  In  tilt  and  3000  arc-scccnds  In  azimuth.  The  vehicle  was 
aeiumed  to  remain  stationary  having  no  velocity  during  ths  two-minute  ground  alignment  period.  Thla  results  In 
the  null-velocity  mechanization  commonly  employed  far  ground  alignment  of  Inertial  platforms.  Ths  asiumptioli 
in  raality  is  in  error  beonute  of  platform  motion  esutad  by  wind  buffeting  and  disturbances,  resulting  from  the 
loading  of  fuel,  cargo,  armament  eto,,  of  the  airframe,  After  the  two-mlnute  ground  alignment  period  at  coordi¬ 
nates  of  latitude  I1  a  12  deg  ,  and  longitude,  \  *  100  deg  ,  the  vehicle  was  accelerated  on  a  heading  B  a  iao 
deg  southward  and  vertically  at  39  and  10  ft/sec1,  respectively,  When  a  ground  speed  of  1000  ft/aeo  was 
aohleved,  a  turn  of  100  dog  at  a  rate  of  3  deg/seo  wee  Initiated  such  that,  at  1  min  40  enc  into  the  mlealon,  the 
airoraft  was  dlreated  northward.  The  klraraft  proceeded  at  a  climb  rata  of  SO  ft/sto  until  thi  orulit  altitude  of 
10,000  ft  was  achieved.  After  one  halt  hour,  the  aircraft  turned  BO  deg  at  a  rati  of  3  deg/seo  end  proooeded 
eastward  for  another  half  hour.  The  mission  terminated  after  one  hour  of  operating  tin*. 


7.S  System  Performance  for  the  Nominal  Feat -React inn  Mission 

The  graphs  shown  in  Figures  12-33  illustrate  syetem  performance  obtained  in  the  fraa-inirtlal,  Oopper-lnertlal, 
LORAN-lnartlsl,  and  aitro-lnertlel  navigation  modes  for  the  faet-reaotlon  mission.  The  performance  measures 
displayed  are  the  error  in  computed  eystem  position  and  .alooity  and  the  azimuth  mieallgnmsnt  it  the  inertial 
platform.  The  performance  wee  obtained  through  tha  use  of  a  digital  eomputer  Monte-Carlo  simulation  program. 

The  curvea  rafleot  simple  root  mean  anuara  fr.m.a.)  values  of  the  Indicated  errors  obtained  from  30  trial  run*, 
This  sample  size  does  not  give  precise  results  but  indicates  the  appropriate  order  of  magnitude  of  trends, 
txtenilv*  model*  incorporating  random  biae,  correlated  noise  and  white  noise  were  employed  to  repreeent  the  arror 
aharaoterlatioi  of  each  navigation  ainior.  Tha  bias  arror*  present  in  eeoh  senior  are  constant  over  any  one 
slaulation  run.  They  vary  from  run  to  run  by  virtue  of  being  eelaoted  randomly  from  a  zero-mean,  uniform  distri¬ 
bution  of  prescribed  standard  deviation.  Thtsa  distribution!  were  derived  mint  digital  random  number  genera¬ 
tors,  The  essentially  white  noise  eourosa  in  aaah  einsor  are  simulated  a*  stauenoee  of  iimplse  selected  randomly 
from  aero-mean,  uniform  distributions  of  prescribed  standard  daviations  derived  in  tha  lame  manner  me  for  the  bias 
error*.  Th*  correlated  noise  eourosi  in  aaoh  sensor  sr*  represented  as  exponential  nolle.  Such  noli*  is  limn- 
lated  by  passing  simulated  white  noli*  through  a  flrit-order  digital  smoother  whose  analog  tie*  constant  is  equal 
to  tha  dailred  correlation  time  of  th*  nolai,  The  standard  deviation  of  the  exulting  whit*  nolso  svqueno*  is 
eelaoted  to  obtain  tha  praaorlbed  standard  deviation  desired  for  th*  correlated  sequence, 

In  tha  following  paragraphs,  performance  obtained  in  each  of  ths  navigation  inodes,  as  shown  in  the  figures,  li 
dlaousaad.  Ths  mechanization  used  for  arror  control  in  ill  ths  navigation  modes  was  ths  Kalman  faadbaok  design, 
baaed  on  th*  sxtramsly  simple  system  error  model  described  above,  in  each  case  th*  quality  and  quantity  of  data 
aval  table' fMt4bch , 'senior  is  defined  and  any  unique  feature  of  th*  partioular  mode  of  operation  la  dlaousaad, 

7.B  Free -Inirt 1*1  Navigation  Mod* 

7b*  system  performance  obtainable  in  th*  frea-inertlil  mode  of  navigation  depends  orltloally  on  tha  amount  of 
tlm*  allotted  to  th*  inertial  platform  alignment  on  the  ground.  It  the  airoraft  take*  off  with  large  platform 
ettltuda  errors,  relatively  large  errors  In  computed  eyetam  position  sad  velocity  will  reeult.  Thle  obtains  ss 
th*  sooslsratlon  information  meaiurtd  in  platform  coordinates  is  proceeeed  in  the  computer  on  th*  asaumptlon  that 
th*  aooelaromatar  axe*  ar*  coincident  with  the  local  geographic  axns.  In  the  augmented  inertial  navigation  modes, 
oompletion  of  ground  alignment  le  not  as  critical,  is  th*  dailred  ooinoldenci  of  the  sotusl  aooelaromatar,  axis 
and  tha  gsogrsphla  coordinates  can  bs  obtained  through  tha  ui*  of  data  from  th*  augmenting  stnsor. 


During  stationary  ground  aliinaint,  platform  attltuds  error  is  removed  in  two  atagoa,  referred  tu  respectively 
as  leveling  and  gyro  compelling.  Vhtn  th*  laval  eucslerontittre  deviate  from  th*  looal  horizon  plane,  their 
sensitive  axee  detect  components  of  th*  local  gravity  veotor.  These  measured  components  result  in  errors  in 
computed  eystem  position  and  velocity  through  subsequent  integrations  In  th*  computer  which  con  then  be  uesd  to 
remove  th*  platform  tilts.  Note,  however,  that,  if  the  platform  is  assumed  stationery,  exact  determination  of 
tha  attitude  error  cannot  be  aohleved  shea  platform  motion  is  caused  Uy  looal  itoohaettc  disturbance*, 


If  thara  exists  a  misalignment  In  the  platform  azimuth  onot  the  Initial  level  error  la  approximately  removed, 
thw  platform  still  tends  to  dovlete  from  the  level  plane.  This  obtains  as  the  platform  Is  rotated  to  maintain 


the  local-levni  orientation  ai  the  earth  rotate*,  Deviation*  of  the  platform  axon  from  tho  naaumod  coordinated 
reiult  in  arrnttenus  rotation  of  tho  platform  ooordlnnte  svetim,  The  reuniting  tilt  cnnnnd  by  the  platform 
azimuth  mint  liniment  wilt  again  generate  errors  in  computed  eystem  poaltiou  and  velocity,  These  errors  then 
.provide  the  basin  to  remova  approximately  the  azimuth  error.  It  should  ho  p.'tad  that  effnctlva  determination 
of  the  error  in  computed  system  position  or  velnaity  duo  to  azimuth  misalUinicnt  can  occur  only  after  platform 
level  has  hoen  obtained,  Oaring  ground  alignment,  platform  leveling  is  achieved  much  more  rapidly  than  the 
gyrooompasslng  of  tha  platform  azimuth.  Further,  an  tho  latitude  at  which  alignment  occurn  in  tnoreaeed,  the 
time  required  for  the  azimuth  gyrocompass ing  aleo  lnoreaaen,  noth  theea  offocta  obtain  an  tho  cooffiolent  in  the 
linear  arror  model  of  the  inertial  nyntom  whloh  Couple*  platform  azimuth  misalignment  to  platform  tilt  is  small 
elth  rsipcct  to  unity  and  dooroasm  in  magnitude  as  tho  latitude  is  increased.  The  speed  at  which  overall 
alignment  le  achieved  ie  aleo  dependent  on  the  eyetem  correction  rate  end  the  r.m.e,  value  ,.nd  correlation 
characteristics  of  the  stooheetlo  motions  of  the  platform.  For  tho  examples  of  this  seotlon,  a  system  correction 
was  made  every  sconnd,  uml  the  null  reference  in  velocity  was  assumed  to  ho  characterized  b.*  u  white  noise  with 
tn  r.m.s.  value  of  1/8  ft/sec, 

from  tills  discussion  we  see  that  the  platform  w'lll  be  aligned  only  after  the  azimuth  error  is  minimized.  In 
Figures  12-14,  system  performance  is  illustrated  for  the  free- inertial  moden  for  ground  alignment  times  of  2, 

4  and  10  minutes.  At  10  minutes,  ground  alignment  has  essentially  been  completed  and  subsequent  errors  shown  in 
computed  system  position  end  velocity  ere  duo  primarily  to  stoohastlo  errors  In  the  Inertial  equipment.  From 
these  particular  results,  the  inertial  system  would  be  referred  to  as  a  0.75  mils  par  hour  insrtlal  system,  This 
inertial  (enaor  error  charactirlitlo  applies  for  all  the  performance  curves  shown  In  this  section.  At  2  minutes, 
a  relatively  larger  azimuth  misalignment  exists.  Consequently,  when  the  aircraft  executes  tha  flight  dynamloa 
described  above,  the  acceleration  measurement  error,  due  to  azimuth  misalignment  dominates  the  propagation  of 
arror  In  computed  aystam  position  and  velocity. 

7.7  Doppler  Inertial  Navigation  Hade 

The  syiteu  performance  obtainable  in  tha  Doppler -Inertial  modi  of  navigation  done  not  depend  critically  on  the 
ground  alignment  time,  ie  once  the  ayeteo  ie  airborne,  speed  seaeurimenta  made  with  tha  Doppler  radar  oan  be  used 
to  continue  the  platform  alignment.  During  tha  period  of  airborne  alignment,  eyetem  performance  will  obvlouely 
be  degraded  with  reapect  to  tha  performance  which  raeulta  when  a  longer  platform  ground  alignment  time  is  aaiumed. 
Since  the  Inertial  and  Doppler  aeneor  both  employ  tha  Inertial  platform  for  stabilization,  no  deviation  between 
the  Inertial  and  Doppler  velocity  veotcri  oceuri  lnatantaneousiy  on  take-off  due  to  platform  attitude  error.  The 
detection  of  attitude  error  reeulte  therefore  from  the  differing  longer  term  error  oharaoteriitlci  of  the  two 
iinaori.  The  oliaraoterletio  errore  in  the  inertial  ayitem  have  frequencies  unrelated  with  the  Schuler,  24-hour 
end  Foucault  coolllatloni.  Since  the  preeenca  of  theee  oeoilletlone  only  in  the  platform  attitude  error  affecte 
the  etablllxed  Doppler  date,  a  bails  far  error  separation  at  the  velocity  level  ezlata.  It  turna  out  that  air¬ 
borne  platform  alignment  Dopplar  data  le  equivalent  in  form  to  ground  alignment  assuming  a  null  velocity  reference, 

The  rapidity  at  whloh  the  velooity  error  charaateriatlce  oan  be  asperated  depends  on  the  quality  end  quantity 
of  the  Doppler  data,  ror  two  uf  the  performance  curves  ihown  in  Figures  15-17,  the  Doppler  wee  eisumed  to 
provide  horizontal  epeed  components  with  an  r.a.e,  blee  error  of  0. 1%  end  tn  r.m.g.  white  noiee  error  of  M, 
Experiments  made  for  this  mission,  ie  indicated  in  Figures  15-17  ahow  that  doubling  of  tha  r.m.s.  hiss  values 
rssulte  in  significant  lose  of  system  performance  if  tha  minimal  Kalman  zaohaniration  is  aoployad.  Suah  aenel- 
tivltlsa  oan  ba  determined  preolsnly  through  the  use  of  the  correlation  anslyaia  technique  described  in  Section 
5.  In  tha  one*  oonsldsrsd  in  Figures  15-17,  different  white  observation  nolee  ODVsrlanoe  metrical,  R,  were 
employed.  These  matrices  differed  over  the  tins  period  from  2  to  30  minutes  in  whloh  most  of  the  platform 
azimuth  misalignment  le  achieved  with  the  Dcpplsr  data.  When  the  It  matrix  is  increased  by  a  factor  of  three, 
the  tuning  factor,  arrora  in  oomputod  velooity  and  tha  platform  azimuth  alignment  arm  ilgnifloantly  reduoed, 

This  ooouri  beoauee  the  Doppler  blae  errors,  unaodeltd  in  the  Kalman  controller,  oen  be  accounted  for  to  some 
extant,  artificially  by  Increasing  the  white  obiervaticn  noise  vsrisnote. 

Using  t!)t  Doppler  date,  oorrootloiis  to  the  modeled  errors  in  oomputed  system  position,  velooity  and  the  plat¬ 
form  attitude  were  made  with  the  Katuan  error  oontrollsr  every  5  eeconde,  Thee*  updates  were  initiated  at  the 
vehlale  take-off.  An  Important  cheraotsrlitio  of  eyetem  error  using  ths  Kalman  leeohanUatlon  is  the  uorraotion 
of  poeltlon  realised  with  the  velooity  date,  In  conventional  design,  einoe  the  correlation  information  relating 
insured  vmloolty  error  and  position  error  is  not  available,  no  beti*  for  updating  the  error  in  oomputed  eyetem 
position  cxlsti.  Consequently,  only  e  bounding  effect  on  velocity  error  ie  realiied  in  oontreat  to  affeotlvs 
control  of  all  ths  modsled  errors  with  th*  Kslman  design. 

7. I  LORAN-Inertlel  Navigation  Mode 

Qyetem  performance  obtained  in  the  LORAN-lnertlal  navigation  mode  is  essentially  limited  only  by  the  quality 
and  quantity  of  the  geodetio  poeltlon  data  darlvtd  from  tha  LORAN  tims-diffarenoa*.  Unlike  the  Doppler  updating 
process,  oxtramsly  rapid  alignment  of  the  inertiel  platform  oan  be  realized  with  the  reoelvsr  data  for  the  faet- 
reaotlon  mission.  This  obtains  as  th*  platform  does  not  play  ths  data  stabilization  role  with  10 RAN  data  that 
it  doss  with  Dopplar  data.  When  the  airoraft  takas  off,  transient  acceleration  arrora  and,  eubatquently,  valooity 
and  position  errors,  exist  in  ths  inertial  eystem  a*  a  result  of  the  platform  attitude  error,  Then  components 
of  inertiel  ayitem  position  error  are  readily  detestable  ualng  tlne-rtlfference  dite  obtained  In  e  region  of 
defined  LORAN  ooverage,  Correction  of  platform  attitude  end  computed  velooity  ie  achieved  with  the  correlation 
date  relating  measured  position  error  to  error  In  oomputed  system  velocity  and  the  platform  misalignment  angle*. 
Th*  rail-time  availability  of  this  information  account!  automatically  for  any  vehicle  flight  profile  or  sequenoe 
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.of  measurement*  of  tiORAN  tlme-differencei.  In  conventional  danlgnn,  a mechanization  which  accounts  for  tliu  Infinite 
variety  of  flight  and  old  date  profl lea  possible  would  require  mi  extensive  amount  of  oomplox  bookkeeping  In  the 
tlrborno  computer,  while  being  Inherently  sub-optimal, 

The  principal  complication  Involved  In  employing  LORAN  ie  preeentod  by  nny  werpage  error  whloh  exieta  bttuucn 
the  ectuel  tlmo-dlfference  grid  end  a  predicted  time-difference  grid  boned  on  aoourate  cnniputetlon  ualng  geodetic 
data.  The  warpnge  la  due  to  unaccounted  variatinnn  along  the  tranemieolon  pathe  between  tlin  I, ORAN  atntlcna  and 
the  elroreft,  which  affect  the  epoed  of  propagation  of  the  electromagnetic  ahergy,  Modeling  of  thune  errors  la 
highly  complex,  aa  the  changing  propagation  patha  continually  introduna  new  conductivity  nnd  reflecting  surface 
varletlone.  In  the  feat-reaction  nlaeion,  the  effect  of  grid  distort  Ion  can  bo  minimised  by  accepting  en 
Initial  eyatein  post t Ion  at  the  airfield  which  le  baaed  on  actual  time-difference  data.  Thla  approach  reaulte 
lh  corrections  to  the  ayetem  which  are  degraded  only  by  the  ahangee  In  dlatortlon  whloh  occur  between  the  air¬ 
field  and  point  of  lnitlni  uae  of  I, ORAN  meaauremcnts.  Consequently,  if  the  dlatortlon  correlation  diatanoe  la 
large  with  respect  to  diatanoe  traveled  bofore  the  LORAN  la  uied,  eysteni  performance  loss  duo  to  grid  varpage 
modeling  error  will  be  email.  Experiments  have  Indicated  that,  If  accurate  stochastic  models  of  the  warpnge 
phenomena  are  employed,  only  sinull  corrections  to  the  grid  dlatortlon  result.  Consequently,  a  LORAN-lnertinl 
syitem  provides  geodetic  position  Informal.  I  no  whuso  accuracy  Is  limited  hy  the  LORAN  tlme-dlf  fnreuco  grid  dis¬ 
tortion.  Aocurate  navigation  can  still  occur,  lunrover,  when  the  aircraft  and  deBtlnatlon  noaltions  are  specified 
in  terms  of  measured  time -difference  coordinates. 

Per  tha  performanoa  curvas  shown  in  Piguns  18-50,  the  LORAN  time-difference  data  wart  asaumad  to  be  contamina¬ 
ted  by  first-order,  80  second  correlated  noiies  with  r,m,s,  values  of  0.14  mtoro-eeconde  and  whlta  noises  with 
r.m.a,  values  of  0.005  mlcro-seoonds,  Tha  LORAN  tlsia-dlffaranoa  data  was  used  to  make  a  ayattm  correction  every 
10  aeoonde,  these  updates  being  Initiated  80  seconds  from  the  take-off  tlma.  In  addition,  constant  bias  or  war- 
page  error  1'  the  time  of  propagation  from  eich  transmitter  to  the  elroreft  are  aaeumed  in  two  of  the  caae*  shown. 
The  r.m.i.  Vi.lt'  i  used  were  1  and  8  micro-seconds,  In  theie  cities,  the  system  position  was  not  initialised  using 
the  LORAN  tlmo-dlfferenoe  data  with  the  result  thnt  highly  degrading  updates  to  platform  aelmuth  alignment  and 
computed  f,  'item  velocity  are  mads  whan  tha  L0R/‘‘  data  la  first  u»*d  aftar  taka-off,  Ono*  computed  vehicle 
position  hex  been  updated  with  the  LORAN  tlmi-d  (ferenoee,  error  ;ue  to  tha  transmission  path  blaaaa  appear*  In 
tha  oooputad  system  position.  Except  for  the  ’..lengta  in  gaodetlo  position  errors  due  to  the  ohanglng  effects  of 
the  time-dlfferenom  bleeee  is  the  vehicle  mov'>>‘ln  the  LORAN  coverage  urea,  the  eubeequent  obeervatlon  errors  are 
caused  primarily  by  the  other  syitem  error  Hurtles,  Consequently,  with  further  updating,  computed  vehicle  velo¬ 
city  tnd  platform  attitude  error  are  brought  under  oontrol  ea  indicated  in  the  figures. 

The  geometry  involving  in  assumed  LORAN  chain  of  three  transmitters  end  the  airore'f  profile  le  Indicated  In 
Plgura  11,  Tho  master  alatlon  la  at  15°  45'  latitude  and  101°  6'  longitude,  the  two  slsvss  ars  at  18°  18'  and 
Is  .48'  latitude  and  00°  30'  and  loo°  40‘  longitude,  respectively.  As  the  alroraft  travels  through  the  coverage 
eras,  tha  oapabillty  of  dadualng  position  from  tha  two  time-differsnets  varies  due  to  changes  in  the  gradient* 
relating  tlne-dlCfarenoe  error  to  gcodetla  position  error,  In  this  example,  position  sen  he  determined  to  a 
r.B.a.  praolslofl  of  1713  ft//eseo  at  the  airfield  end  3901  ft/useo  at  the  million  termination  point  for  lndapendant 
r.m.l.  errors  of  e  mlcro-eeoond  In  bath  tlme-dlfferenoee, 

7.0  Astro -Inertial  Navigation  Mods 

■yetem  performanoa  in  tha  aatro-lnartlal  navigation  mode  la  limited  by  the  oapabillty  of  the  tracker  to  look 
onto  a  light  source  In  the  ambient  nolai  environment  and  the  accuracy  with  whloh  the  traoklng  axle  can  be  re¬ 
lated  to  the  local  geographic  axes,  The  tracking  precision  It  dipsndsnt  on  electronic  component  nolee  of  the 
tracker  and  the  brightness  of  the  star  ralatlva  to  lta  Immediate  background.  The  eaouracy  In  determining  the 
engv*  ><  .Mentation  of  tha  traoker  axle  with  raspiot  to  tha  local  geographic  coordinate!  la  dependant  on  the 
ac  t  -cy  of  tha  meohanioal  allgnmant  of  the  traokar  glmbal  axta  to  the  rtfarinoa  lnartlal  platfotm  axaa  and  to 
tha  aoouraoy  of  tha  allgnmant  of  thaaa  platform  coordinates  to  the  gsographlo  frame. 

In  the  fast-raaotian  minion,  the  dominant  system  error  at  the  first  star  shot  is  the  platform  atimuth  mis¬ 
alignment,  Thle  error  le  very  observable  at  this  time,  as  the  error  In  computed  eyetem  position  and  error 
associated  with  the  tracker  ere  relatively  small.  Consequsntly,  in  sooursts  alignment  of  tha  platform  azimuth  Is 
aohUved  with  the  first  syitem  correction.  Subsequent  eyetem  oorreatlons  serve  primarily  tn  bound  the  three  plat¬ 
form  aieaUgnmant  angle*  and  th*  error*  in  computed  eyetem  position. 

fignlfloant  errors  oan  be  made  In  conventional  eetro-laertial  eyetem  aecbinlsationa,  is  thus  meoliinlaitlons 
usually  assume  that  the  platform  reference  coordinate  ayetsa  is  looally-level,  This  assumption  results  In 
•rroneaus  updates  to  oomputed  position  and  platform  azimuth  to  offset  any  stilting  tilt.  An  aro-aeoond  of 
poiltlon  error  created  by  an  aro-aeoond  of  platform  tilt  Is  tpproxlmstely  103  fsst,  In  e  Kalman  arror  auntrollsr 
design,  th*  contribution  of  tilt  to  observed  star  position  error  oen  be  modeled  end  accounted  for  properly  in 
aygtsm  updating,  The  itnaltivity  between  attitude  error  and  ayetem  poiltlon  arror  tmpllei,  however,  that  tilt 
Inducing  errors  raqulra  adaquats  modeling  in  the  Kalman  design,  Th*  main  advantage  of  a  Kalman  mechanization  in 
aatro-lnartlal  navigation  aystami  la  tha  automatic  accommodation  of  th*  Infinite  variety  of  etir-to-vehlole 
position  relationships  poeelble.  Data  reaultinl  from  aaoh  star  ahot  in  an  arbitrary  sequence  oan  ba  optimally 
esployed,  ae  oonaideratinn  la  automatloally  mid*  for  tha  residual  error  oolnoldant  with  the  optical  axle  end  the 
ourrci.t  relationship  between  attitude  error  and  arror  In  computed  system  position  when  the  oorrtotlon  is 
determined, 
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For  the  performance  curve*  shown  In  Figures, gl-33,  the  eter  elevation  untl  bearing  angle  measuremnntn  urn 
contaminated  by  e  first-order  oorreUtod  naUe  with  r.m.s,  value  of  5  uro-aeeonde  and  a  correlation  tlmo  of  4 
Hours,  In  eddltlon,  a  white  noise  of  r.m.s,  value  3  tro-sosonds  was  assumed,  Two  stars  wore  considered  In 
making  the  i  •  stun  oorreotlons,  These  stars  had  elevation  angles  of  30  and  60  degreos  and  bearing  nnglen  of  r.oro 
and  130  d  i  oes,  reipnotivoly,  The  shots  alternated  between  the  two  stare,  being  made  every  60  seconds  und 
initiatin'  oo  seconds  after  take-off,  In  Figures  21-211 ,  selected  curves  from  the  preceding  sets  nf  figures  f  -ve 
been  diap|.<v«d  to  permit  convenient  oomparlaana  of  aystem  performance, 


I.  (V'.dLlphlON 

This  ohspter  has  oonsldcrert  the  application  of  Kalman  filtering  theory  to  error  control  in  multi-sonaor  navi¬ 
gation  aystsms  by  dstelllng  a  particular  error  control  design,  The  reader  has  been  Introduced  to  the  buttle  -.ypos 
ol'  existing  navigation  sensors  and  how  their  complementary  characteristics  havs  been  exploited  in  the  past  In 
augmented  lnortlal  navigation  systems,  The  practical  aspects  of  Implementing  the  much  more  sophisticated  Kalman 
arror  controllers  w«r«  discussed  as  well  as  practical  synthesis  techniques  which  have  been  employed  tc  renllto 
computational ly  feasible  designs.  The  doslen  example  which  was  oonsldorod  illustrated  systom  performance  It.  the 
principal  navigation  modes  to  portray  the  particular  characteristics  of  tho  navigation  sensor  augmenting  th- 
inertial  system, 

Tha  state-of-the-art  In  the  application  of  hlghly-complax  data  prooesalng  teohnlquoe,  such  us  Kalmnn  filtering 
thsory,  is  rspldly  changing,  The  use  of  theee  eophlstloeted  procedures  is  liciited  by  the  capability  of  digital 
computation  aquipmeat  available  for  the  eyntheiie  of  epproprlate  designs  end  the  mechanization  of  thasa  designs 
iu  aotual  systems,  Limitations  In  aoitu  applications  exist  owing  to  the  lack  of  Information  adequately  identi¬ 
fying  and  describing  all  consequential  system  error  eherecterletloe, 

As  the  cost  of  computation  decreases  and  more  information  defining  system  error  behavior  beoomai  available, 

•ora  marked  improvements  In  navigation  ayatam  aoouraoy  oan  be  achieved  with  existing  sensors.  A  relaxation 
of  Individual  senior  accuracy  requlramnnta  permitted  by  more  complex  software  design  will,  In  turn,  permit  simpler 
sensor  design.  Humor  slmpllfioatinn  coupled  with  nhtural  design  Improvements  oen  result  In  less  costly,  lighter, 
more  reliable  and  more  easily  maintained  sensors,  Theee  more  sophisticated  error  oontrol  techniques  Imply  a  shift 
from  complexity  In  hardware  to  complexity  In  software,  resulting  in  navigation  ayatam  designs  with  higher  aoouraoy 
and  reliability,  simpler  maintenance,  and  raduued  alee,  weight  ind  cost, 
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CHAPTER  U  -  APPLICATION  OF  KAI.MAN  F1LTERINO  TO 
BARO/INKRTIAL  HEIGHT  SYSTEMS 

P,M. Barham  md  P.Munvlllw 


I.  INTRODUCTION 

Tha  aviator  baa  had  no  alternative,  until  recently,  to  tha  use  of  barometric  pressure  aa  the  anurcn  of  hla  holuht 
and  height  rata  Information,  Deeplte  the  Ingenuity  of  the  donigner,  which  Imn  resulted  In  thb  development  of  aom 
extremely  sensitive  and  aenurato  lnstrumonte,  the  fact  remains  that  tho  uee  of  pressure  necessitates  assumptions 
about  the  atruotura  of  tha  atmosphere  In  order  to  derive  height  or  height  rata,  Thia  has  led  to  the  oonoapt  of  a 
itandard  abaoaphtre  (a,g.,  ICAN),  Errors  osn  ooour  due  to  variations  In  tha  lapaa  rata,  tha  height  of  th«  tropo- 
pause  and  in  asa-level  temperature  and  praaaura.  Evan  though  a  datum  is  aitabliehod  before  take-off,  this  means 
that  climbing  or  diving  through  a  non-standard  atmoaphera  will  result  In  hslght  rats  errors  of  up  to  BE,  with 
oorroaponding  errors  In  hslght,  Tha  two  "actuals"  shown  in  Figure  5  wars  recorded  on  the  same  day  (let  March 
1M7),  one  over  Cornwall  and  tha  aeoond  600  nautioal  allaa  further  north,  over  tho  Shetland  Tales,  In  taoh  oaaa 
the  prtsaure  error  1*  teen  to  oorreepond  to  a  mean  slope  (of  0,0(5  and  0,015  respectively)  with  a  random  nolsa 
supsrimpoaad.  With  variations  In  ths  sign  and  magnitude  of  tha  naan  slops,  these  srs  typical  raoprda,  Effaota 
■uoh  is  lsg  and  hysteresis  asks  it  very  dangerous  to  rely  on  height  rats  accuracy  at  tlmaa  whan  height  rata  Itself 
la  changing  rapidly  (such  a*  during  an  ovarihoot  whan  landing). 

It  wat  natural  therefore  that,  with  tha  advent' of  praotloal  inertial  platforms,  tha  avlonloa  system  designer 
should  have  looked  with  Interest  bo  aaa  whet  help  ha  could  gat  from  tha  vertical  Inertial  channel.  Unlike  the 
horlsontal  channels,  which  ars  comfortably  bounded  by  the  Sohuler  loop,  the  vertical  channel  la  unstable,  eo  that 
any  accelerometer  trrore  will  oauea  the  height  error  to  lnoramaa  aa  the  aquars  of  tima.  Moraovar  tha  affaot  of 
gravity  on  tha  vartloal  acoalaromatar  has  to  be  cancelled,  since  this  correction  la  height-depandent,  an  error  in 
aaauaad  height  will  raault  Id  an  eooelsration  ermr  in  tha  unit  which  will  lnoraaaa  tha  original  error. 

Howavar,  It  la  easily  aaan  that  barons trio  and  Inertial  height  systems  era  largely  complementary  to  aaoh  other, 
The  farmer  provides  good  height  rets  Information  In  nearly  laval  flight  (aubjaot  only  to  tha  alopa  nf  tha  laobara 
la  tha  vartloal  plana,  which  is  typlaally  1  foot  par  milt  standard  deviation),  but  la  poor  in  olimbs  or  divas  or  in 
tha  presence  of  significant  vartloal  aooslarstlou.  On  tha  other  hand  tha  Inertial  system  nerds  to  be  hounded  by 
an  asternal  referanoe  (auoh  as  barometrlo  data)  for  auotalnad  periods,  but  provides  direct  information  about 
vartlotl  aoaaliration  and  a  good  ahorc-tarm  referanoe  for  uaa  during  climbing  or  diving. 

Tha  us*  of  iuoh  baro/inartlal  mlxad  ayatama  i«  considered  In  aora  detail  below, 


3.  TRADITIONAL  BARO/INERTIAL  MIXING 

The  operation  of  a  Kalman  filter  in  a  bsro/inartlal  height  system  cannot  be  fully  spprsolatsd  without  first 
oonsldarlng  tha  sort  traditional  alxlng  systems  and  thalr  limitation*. 

1.1  FUad  Osin  Sy  a  tarns 

Tha  bade  mixing  loop  la  shown  In  Flgurw  1,  Thsrw  la  no  drift  oompansatlon  for  tha  Inertial  ohannsl  and, 
aaaumlng  that  the  ayatam  la  trimmed  bafora  flight,  thw  dominant  error  at  high  altituda  would  probably  b*  poor 
"I"  ooapanaatlon  due  to  tha  usr  of  arronaoui  height,  in  a  cioiad-loop  olimb  inertial  height  (hj)  will  b*  forowd 
to  follow  ohangaa  in  praaaura  halght  (hp)  with  rasultant  height  rata  irrora  of  up  to  8%.  On  tha  other  hand,  during 
an  opan-loop  climb  tha  ayatam  would  soon  baooma  unatabla  because  of  tha  unoompanaitad  acceleration  errors.  Tha 
transient  which  would  normally  ooour  on  ra-oloilai  tha  loop  could  be  raduoad  by  a  “fast  re-set"  phase,  in  which 
tha  luadbaok  throuih  K,  la  taaporarily  lnoraaisd. 

Addition  of  drift  oompanaatloa,  as  shown  in  Figure  8,  would  Improve  tha  opan-loop  climb  aa  tha  Inertial  ohannal 
would  now  atart  in  a  wall  trimmed  state.  Howavar,  ayah  with  a  fast  ra-sat  tha  ayatam  cannot  sattlt  without  a 
lengthy  transient  on  ra-oloalng  tha  loop  aa  the  sot  of  forcing  h,  to  equal  hp  will  naoaiiltgta  additional  drift 
oompanaation  to  aocommodata  tha  new  error  in  *g"  oorraotion, 

Adding  a  prataur*  halght  oorraotion  loop,  aa  shown  in  Figura  3,  la  a  big  Improvident  aa  it  removal  the  transient 
oo  ra-oloaing  tha  inartlal  loop  and  la  making  an  attempt  to  operate  in  "trua”  height,  It  oparatei  in  two  different 
statu  bestd  on  tha  following  assumptions: 

(a)  in  laval  flight  tha  barometrlo  'lata  gives  perfaot  halght  rata  (Ignoring  alopa  of  laobara)  and  oan  be  uaad 

to  trim  accurately  the  Inertial  ohannal,  PRECEDING  PAGE  BLANK 
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(b)  In  a  short  period  of  climbing,  the  luertUl  channel  mav  bo  eoneidered  perfect  end  used  to  deterelne  the 
error  in  ohan«e  of  heilht  eo  indicated  by  the  barometric  unit. 

in  practice  some  difficult  compromises  are  neoeieary.  Perfectly  level  ill  ".lit  can  never  be  achieved  and,  to 
keep  the  inertial  channel  bounded,  it  la  neceeeary  to  remain  in  the  closed-loop  state  up  to  moderate  height  rates, 
in  which  case  the  pressure  height  rates  can  have  ilgnificant  errors.  If,  on  the  other  hand,  the  switching  takes 
place  at  lower  height  rates,  the  Inertial  channel  could  bo  left  open-loop  for  excessive  periods  during  slow  ollmhs, 
with  resultant  Instability, 

2,2  Variable  Gain  System* 

The  shove  considerations  lead  one  to  examine  the  possibility  of  using  a  variable  gain  syat.-n,  as  shown  in  Figure 
4.  rather  than  direct  switching  between  tho  third  and  fourth  integrators.  Both  K,  ar.d  K„  can  be  made  hetght- 
rato-dapendent.  In  level  flight  K3  =  1  end  K„  =  0  ,  so  that  the  system  becomes  equivalent  to  the  system  in 
Figure  2.  With  increasing  height  rate  K„  will  increase  and  Ka  Mil  decrease.  The  error  signal  Is  now  distri¬ 
buted  between  the  Inertial  and  barometric  systems  according  to  ‘.he  values  of  K3  snd  K„  .  This  is  similar  to  tho 
multl-dlmenslonal  carre; t Ion  to  the  state  vector  after  a  measurement  with  a  Kalman  filter,  end  the  values  of  K3 
and  K  are  being  used  in  a  similar  way  to  the  appropriate  terms  in  the  gain  matrix.  Despite  the  increase  of 
complexity  the  system  In  Figure  4  is  still  very  imperfect  compared  with  the  Kalman  filter  described  in  Section  3. 

With  a  Kalman  filter  the  error  between  forecast  and  measurement  results,  in  general,  in  corrections  being  fed 
beck  to  all  the  elements  in  the  state  vector  in  accordance  with  the  ourrant  values  in  the  variance  matrix,  Thia 
is  roughly  analogous  to  K,  and  K4  In  Fi- ire  4  also  boing  made  varlabla.  Of  greater  importance  is  the  fact  that, 
with  the  Ktloan  filter,  the  terms  in  the  v.->innoe  matrix  refleot  the  previous  history  of  the  system  and  are  not 
simple  functions  of  height  race.  For  example,  If  a  prolonged  period  of  level  flight  had  reeulted  in  a  very  well 
trimmed  inertial  aystom,  and  lienoe  correspondingly  small  value*  of  variances  associated  with  it,  almost  the  whole 
dlaoiepanoy  arising  at  the  start  of  a  climb  would  be  attributed  to  an  abnormal  atmosphere,  regardless  of  height  rate. 
Flnall.  the  filter  described  below  has  a  built-in  capability  to  learn  th*  structure  of  the  atmosphere  and  make  short¬ 
term  use  of  this  knowledge.  , 
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3.  THE  KALIAN  FILTER  HEIGHT  SYSTEM 


3.1  The  Stela  Vector 

Since  the  ^urpoae.af  the  filter  ia  to  oonbrol  the  vertical  channel  of  an  Inertial  navigator  it  la  obvious  that 
the  etate  vector  should  lnolude  term*  representing  th*  beet  estimates  of  the  errors  of  inertial  acceleration  (e  Sj), 
velnoity  (<  vt)  and  height  («  ht),  Measurement  will  oonslet  of  a  comparison  of  inertial  and  preeaure  height,  so  a 
term  reoreienting  error  In  preeaure  height  (<  Hp)  must  be  inoluded.  With  the  subeoripts 
inertial,  preeaure  and  true  value*  reapectively,  the**  are  defined  as  follows; 


l  ,  p  und  t  ^presenting 
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(3.1) 
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(3.2) 

«  ht 

=  ht  -  hj 

(3.3) 

‘  S 

*  ht  -  bp  . 

(3.4) 

To  enable  th*  filter  to  learn  something  of  the  deperturil  from  stindard  of  the  atmosphere,  a  further  element 
(S)  le  inoluded  in  th*  etate  vector.  Thle  1*  defined  by  the  relationship 


^  =  i't<1+s> 


(3.8) 


and  is,  in  effaet,  th*  elope  of  the  plot  of  preeaure  height  error  againet  true  height  The  complete  state  veotor 
thur  becomes 
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3,2  The  Traaaitlon  Hatrla 

Examination  of  th*  chosen  state  vector  ehowa  that  th*  first  three  term*  are  concerned  with  th*  open- 'top  inertial 
■ystea,  tad  th*  last  two  term*  with  the  atmospheric  model.  These  two  eet*  only  intereot  te  a  result  of  the  measure¬ 
ment  prooeae  which,  of  oourie,  builds  up  a  strong  correlation  between  inertial  und  pressure  height  eetrmstes. 
However,  In  developing  the  transition  matrix,  whloh  controls  the  updating  process  by  th*  equations  of  motion,  the 
tmo  cat*  can  be  considered  separately. 
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Now  th*  elMslotl  equitions  of  notion  for  *  uniformly  tcowltruUng  syitts  without  any  ftedbiok  cin  be  expressed 

at 

*  hj  1  t  it*  ‘  h, 

<  v4  =  0  1  t  ‘  vt  ,  (3.7) 

.*  *1.  h*i  0  l.  f  li.  k 

where  t  la  the  tine  interval  between  atete  k  and  atate  (k  +  1),  and  must  be  ehoaen  ao  that  the  acceleration  error 
nay  be  considered  constant  durlnt  one  step.  However,  in  the  vertical  channel  o I  an  Inertial  navigator  there  exists 
an  additional  feedback.  A  height  error  In  calculating  the  value  of  “g"  will  give  an  acceleration  error  of  3  x  10*' 
ft  seo*J  for  every  foot  of  height  error.  If  i  a0  la  the  acceleration  error  Iron  all  cauaea  other  than  erroneous 
V  compensation  (i.e.  untrlnned  accelerometer  drift)  which  may  be  considered  constant  between  two  successive  stops, 
then  the  total  error  is 

*  »i  =  ‘  s0  +  (3  *  10‘‘)e  ht  . 

Considering  now  the  change  in  e  Sj  during  one  cycle,  we  have 

tl)  *  3  v  10MA(S  hj) 

*  3x  10“4 (t  «  Vj  +  |t*  «  Sj) 

=  (3  *  10'*t)«  vt  +  (l.S  <  10'*tJ)t  at  . 

Hence 

(«  *i)kM  *  («  aj)k  +  A(«  at) 

=  (3  «  10"‘t)(<  V^)k  +  [l  +  (1.3  *  10*‘ta>](€  a^,,  .  (3,8) 

The  transition  matrix  for  the  inertial  channel  thus  baooaas 


[p  3  «  10‘*t  [l  +  (l.S  »  tO_*t*>]J 

Of  the  reaalnlng  terms  in  the  state  vector  S  should  Ideally  have  both  a  time  and  a  distance  correlated  expo¬ 
nential  decay,  since  it  is  obvious  that  any  data  on  atmospheric  structure  would  become  of  little  use  after  a  pro¬ 
longed  period  of  time,  or  at  a  distant  location.  However,  in  view  of  the  difficulty  of  modelling  a  correlation  with 
distance  it  waa  decided  to  use  only  an  exponential  time  correlation  with  an  arbitrarily  chosen  10,000  second  time 
oonataat.  This  is  represented  as 

5,,^  «  (1  -  10-*t)Sk  .  (3,10) 

Prom  the  definition  of  5  in  Equation  (3,5)  and  of  <  hp  in  Equation  (3.4),  we  have  that 

A(«  hp)  a  (fet  -  &„)t 


where  Ah  *  J*  h0  dt  ,  (3, 

i„  being  the  computed  beat  eatimita  of  height  rate.  ...  . 

n>u*  <«  hp)ktl  =  (*  hp) k  -  Ah8k  ,  (3 

Combining  (3.0),  (3,10)  end  (3.12),  the  complete  transition  matrix  for  the  state  vector  it  (3.6)  becomes 
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3.3  Ttn  Measurement  Matrix 

Tho  meaxurement  matrix  required  for  baro/incrtial  mixing  la 

«  =  Cl  0  0  0  -l]  .  (3.14) 

Thli  eelectx  (ran  the  itete  vector  the  terns 

«  hj  -  *  hp  s  (ht  -  ht)  -  (ht  -  hp) 

*  hp  -  hj  . 

3.4  Plant  Noise 

3.4.1  Acceleration 

Plant  nolee  on  acceleration  can  arise  troo  a  number  o(  causes,  of  which  the  following  are  o(  most  significance: 

(a)  random  ohnngos  in  bias  level,  which  typically  occur  every  10  minutes  on  average  with  changes  with  a 
standard  deviation  of  about  10*1  g 

(b)  | *  distortion  (with  a  foroe  feedback  accelerometer)  with  a  typloal  level  of  2  *  10*!  g/g*  for  a  typical 
Inertial  quality  accelerometer, 

Considering  each  of  these  in  turn,  the  random  changes  increase  the  varlsnoe  by  10* 10  a*  every  10  minutaa,  or 
hy  17  x  10* 10  ft1  sec*‘  in  one  10  second  oycle. 

The  second  cause  is  mors  difficult  to  assets.  Hcwever,  an  txaml nation  of  the  acceleration  power  speotral 
densities  for  a  typical  strike  aircraft  enables  us  to  derive  some  approximate  figures.  Assuming  an  intl-vlbratlon 
mounting  with  t  10  o/s  resonant  frequency,  and  typical  damping,  the  power  spectral  densities  art  first  weighted 
by  the  square  of  the  amplitude  transmission  curve  for  the  mounting  and  then  integrated  over  frequency  to  provide 
tiean  square  acoeleration  power  levels  for  typical  flight  conditions.  These  can  be  converted  into  equivalent  bles 
levels  by  application  of  the  assumed  g!  distortion  coefficient  of  3  x  10* 1  g/g*.  It  ia  found  that,  for  the  air¬ 
craft  investigated,  the  highest  level  ooours  while  pulling  high  "g”.  This  is  followed  in  descending  order  by  take¬ 
off  and  landing  and  then  by  high  IAS  divgg  st  e  factor  of  20  down  on  the  high  “g"  case, 

fa  are  not  lntercetad  in  the  eheulute  level  of  vibration,  or  the  reeultent  bias,  but  in  the  variance  of  the 
'Change  of  bias  per  computing  ojolo  (10  'seconds),  Consider  .a  simple  .exempts  of  a  flight  which  hea,  on  average,  one 
high  "g"  uinoeuvre  every  10  minute*  (with  t  bits  level  of  10**  ft  eio*‘),  the  reet  of  the  flight  being  atraight  and 
level  (negligible  bias).  This  will  result  in  two  changes  of  bite  level  for  each  manoeuvre,  or  ons  change  In  every 
30  computing  cycle*.  This  glvte  m  varlmnot  of  the  change  of  moeeleretion  bias  per  step  of  3.3  x  10*10  ft*  sec'*, 
or  about  20%  of  that  due  to  random  change!,  Similar  conaidaration  of  a  high  IAS  dive  occurring  on  average  onoe  every 
5  minutes  result*  in  a  negligible  variance  of  0,02  x  10*lc  ft*  aso**,  which  lndlcmtss  that  only  ths  high  “g" 
manoeuvre!  need  be  considered.  Allowing  a  amall  increase  in  variance  to  acoount  for  other  conditions,  the  plant 
noise  aoaaieti  of  the  addition  taoh  cycle  of  21  *  10*l°  ft*  esc**  to  the  variance  of  acoeleration  error. 

3.4.2  Departure  fror  Standard  Atmosphere  (5 ) 

It  wu  assumed  that,  overall,  ths  standard  deviation  of  S  was  0,03,  although  thira  is  some  evidence  that  s 
higher  value  should  be  chosen.  In  prolonged  level  flight  s  plant  noise  contribution  li  required  to  maintain  this 
level,  despite  the  deaay  term  Introduced  into  the  traneition  matrix,  for  a  10  iscond  oyol*  this  term  le  0.SBB, 
which  results  In  the  varlsnoe  p  of  8  varying  as 

pktl  =  (0.98B)*Pk  +  n  , 

where  n  1*  the  plant  nolea  contribution.  If  pkM  a  pk  s  (0.03)’  in  the  steady  state,  it  1*  required  that 
n  =  l.s  x  10**  during  level  flight. 

During  ollabs  or  dives  it  is  obvious  that  ths  probability  of  a  change  of  elope  of  the  atmospheric  error  1* 
increased  Analysis  of  typical  measured  atmospheres  (see  figure  S)  lndicette  an  additional  contribution  to  the 
variance  of  5  of  about  4,8  x  10**  fi I  for  a  10  seoond  oycle,  where  l&!  li  tb*  modulus  of  the  height  rate  In 
ft  esc*1. 
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The  total  plant  noil*  to  be  added  to  the  varianos  of  5  each  cycle  le  thus  (1,8  +  4.8lfil)  x  10". 

3.4.3  Preexur*  Height 

On  the  assumption  that  all  laobario  aurfaoea  are  horisontsl  planes,  any  uncertainty  in  preisure  height  must 
arl««  from  a  lack  of  knowledge  of  the  true  value  of  S  during  a  climb  or  dive.  This  ia  allowed  for  by  ths  plant 
noise  on  S  described  eboY*.  However,  in  praotio*  the  laobarlc  lurfaosn  in  any  region  will  be  slightly  eloped 
(with  a  standard  dsvlaticu  of  about  1  foot  per  nautioel  mile),  The  system  has  no  naans  of  determining  such  a  slope, 
apart  from  making  height  fixes  (which  are  discusead  below).  To  implement  such  a  system  would  require  two  e.xtra 
terms  in  the  state  vector  (northerly  end  sisterly  slopes)  which  would  couple  into  the  pressure  height  correction 
tens  through  terms  in  the  transition  matrix  involving  displacements  determined  by  the  horizontal  channels.  This 
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would  be  directly  equivalent  to  the  ooupllm  of  S  Into  the  height  error  by  the  Ah  tern.  In  practice  euch 
a  refinement  la  hardly  practical  In  the  abaence  of  a  continuoua  external  neaeurement,  euch  aa  vertical  Doppler, 
and  would  not  bo  worth  the  extra  complication.  It  nuat  be  appreciated,  however,  that  without  auch  terms  the 
predicted  height  and  height  rate  errora  and  their  varlanaea  are  rulatlvo  to  the  ieobnrlc  surtecea  and  not  to  a 
horlaontal  datum.  To  allow  for  ohangea  In  elope,  however,  a  email  amount  of  plant  nolae  la  added  dlreotly  to  the 
preaauro  height.  This  amounts  to  the  addition  of  4  a  10*'  ft'  to  the  variance  of  pressure  height  at  each  computing 
oyole. 

3.  S  Measurement  Nuts* 

The  measurement  noise  la  the  inability  of  the  system  to  determine  the  correct  static  pressure  of  the  undisturbed 
atmoaphara  outside  the  aircraft.  This  la  saaentlally  pooullar  to  a  particular  system  end  would  need  to  be  carefully 
studlod  In  oach  practical  case.  However,  for  the  purposes  of  this  study,  some  general  observations  were  made  for 
use  In  mathematical  modelling.  Sources  of  error  considered  Included 

(a)  random  Instrument  nolae, 

(b)  hyateroals  effects, 

(o)  Instrumental  lags, 

(d)  affects  of  wind  auats, 

Tha  first  thraa  arrora  wers  studied  for  a  typical  modern'  force  re-balance  air  data  eyiteu.  The  random  Instru¬ 
ment  nolae  wag  found  to  hava  a  standard  deviation  of  about  0,11  millibar.  Although  relatively  larga  under  some 
conditions,  hysteresis  and  lag  effaoti  were  found  to  ba  vary  raproduolbla  and,  aa  suoh,  oould  ba  allowed  for  by 
modelling  in  the  digital  computer  of  a  practical  system.  In  this  oaae  only  the  etatlstloa  of  the  error  in  modelling 
need  he  considered. 

The  gotual  pressure  changes  occurring  due  to  guiti  ire,  In  general,  amall,  Paak  value*  of  typically  1  millibar 
ohangt  In  1  kilometre  can  be  reoorded  during  thunderstorm  and  about  an  order  leas  in  ordinary  "guety"  conditions, 
Htnoe  the  "all  time,  al.1  weather"  standard  deviation  must  be  very  small,  It  ihould  be  noted,  however,  that  a  poor 
design  of  pltot-atatle  will  result  in  air  veloeity  ehangeu  during  gusts  being  recordod  as  paeuda-preasure-ohangoa. 

For  the  purposes  of  mathematical  modelling  tha  overall  standard  deviation  of  measurement  nolle  wae  assumed  to  be 
0,13  millibar  for  |fi|  <  25  ft  see*1  and  0.32  millibar  for  |M  3  25  ft  no*1  .  These  were  converted  to  height 
errors  by  the  uaual  relationship  of  (O.Bh*  *  10*’  4  27. 8)  fast  par  millibar.  The  two  conditions  were  introduced 
on  the  grounds  that  lag  effects  are  more  significant  during  ollmbs  end  dives.  In  practice,  of  course,  the  meeaure- 
ment  nolle  used  could  result  from  a  study  or  the  actual  system, 

3.6  Height  Pixta 

For  a  height  fix  using,  for  examplo,  a  radio  altimeter,  the  required  measurement  matrix  la 

H  »  U  0  0  0  o)  . 

This  salecti  *  hj  from  the  state  veotor,  which  is  compared  with  (hr  +  hg  -  hi),  where  hr  la  the  radio  altimeter 
height  and  h,  li  the  height  of  the  ground  above  datum.  Slnoe  In  the  steady  state  the  normal  baro/lnertlal  measure 
mente  result  in  a  correlation  between  Inertial  and  preieure  height  which  approaches  unity,  the  lame  oorraotion  will 
usually  ba  made  to  both. 


4.  THE  HATHEHATICAL  HODEL 

Orthodox  mode 11 In i  was  used,  making  uaa  of  gtuaalgn  weighted  random  numbers  of  appropriate  standard  deviations 
to  ganarata  dlaereta  errora  for  the  "real  world"  model.  One  point  of  Interest  to  this  particular  ossa  la  tha  modal 
uaed  for  tha  atmosphere.  Examination  of  a  number  of  reoorded  atmosphere  error  plots,  two  of  which  are  shown  In 
Figure  B,  had  suggested  a  fairly  wall  defined  main  llopa  In  each  oaae,  with  random  noise  auparlmpoatd.  The  latter 
oould  b«  approximated  by  a  serial  of  straight  Una  isgmtnti  oonneotlng  polnta  with  a  main  separation  in  height  of 
about  5000  ft  and  with  a  standard  deviation  departure  from  the  mean  slope  of  100  ft. 

A  gerlea  of  random  numbers,  with  rectangular  distribution  In  tha  ranga  0  to  1,  wtra  drawn  until  ona  of  them  fall 
within  the  range  0  to  0.1.  This  wai  taken  to  represent  a  ahange  point,  etch  number  In  the  aeries  corrsipondlng  in 
a  height  ohinga  of  500  ft.  Thui,  If  the  seventh  number  drawn  wae  the  first  to  fall  within  the  range  0  to  0.1,  thle 
represented  a  ahange  point  it  3500  ft.  A  gausalan  weighted  random  number  with  standard  deviation  100  ft  was  then 
drawn  to  represent  the  departure  of  thle  change  point  from  the  line  of  mean  ilope.  A  aerlei  of  change  polnti  with 
mean  separation  5000  ft  were  thus  generated  and  wars  Joined  to  provide  a  modal  of  the  atmosphere.  The  full  lines 
In  Figure  5  show  typical  models  generated  In  this  manner  (with  mean  alopti  of  0.05  and  0.15  respectively).  It  is 
aeen  that  they  aoopare  well  with  the  actual  records. 

Due  to  the  muoh  lower  level  and  similar  frequency  of  ('  distortion  changes  compared  with  random  accelerometer 
ohangea,  It  was  not  thought  worthwhile  to  modal  both  effeota  separately.  Instead  the  Irequenoy  of  rtndom  changes 
was  slightly  lnareiaed  to  compensate.  Thus,  on  eaoh  cycle,  a  random  number  in  the  range  0  to  1  was  drawn.  If  this 
fall  within  tha  ranga  0  to  0.02  a  gausalan  weighted  random  ohange  of  standard  deviation  0.00032  ft  seo'J  was  tdded 
to  the  "real  world"  acceleration  error. 
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I.  REUULTS 

■oa*  typical  result*  obtained  with  th#  mathematical  model  are  ehown  tn  rigur#*  8-10.  No  raaulta  have  baan 
ihowi  for  ahort  duration  high  rata  oliobs  or  divoa,  aa  tha  arrora  arlaing  from  thaaa  ara  naglltlbla,  dua  to  tho 
high  dagraa  of  rallanca  plaead  on  tha  lnartlal  channel.  It  ahould  alao  ba  appreciated  that  ravaraala  of  height 
rata  alao  produea  ravaraala  of  tha  "forcing  function",  that  la  tha  arroneoua  height  rata  derived  from  praaaura, 
ao  that  the  Kalman  filter  la  eaally  abl*  to  separata  inertial  and  barometric  arrora.  This  la  an  Important  feature 
ehlch,  unlike  tho  eyateoa  doecrlbed  in  Section  3,  enables  tha  inertial  channel  to  be  trlmmod  accurately  during 
typical  terrain-following  profiles.  Theoretically  the  filter  can  diatinguieh  between  preaaure  end  inertial  errors 
whenever  the  height  rate  changes  at  all. 

for  this  reason  long  climbs  at  low  rates  have  been  illustrated  ae  representing  the  voret  case  for  the  filter, 
Figure  8  ohows  the  height  rate  error  and  etandsrd  deviation  for  a  climb  tu  80,000  ft  at  180  ft  boo*  through  an 
atmoaphera  with  mean  5  «  0,08  after  en  initial  settling  period  of  levol  flight.  A  further  five  minutes  of 
level  flight  is  followed  by  a  dive  at  tho  same  rate,  levelling  out  at  ground  level.  The  standard  deviation  Just 
exceeds .0. 3  ft  sec*1  at  the  end  of  the  deeoent.  hut  rauldly  dropa  to  a  negligible  amount  on  regaining  level  flight. 
The  aotual  error  for  this  run  is  within  the  standard  deviation  ourvo  and  shows  no  systematic  trends.  The  corres¬ 
ponding  height  error  with  its  standard  deviation  la  shown  In  Figure  7  and  reveals  a  similar  pattern,  the  standard 
deviation  reaching  about  80  ft  at  the  end  of  the  descent.  This  height  rate  is  of  considerable  Interest  as  it 
represents  an  especially  difficult  one  for  traditional  height  systoma. 

As  the  worst  oate  for  the  Kalman  filter  height  unit  la  a  very  prolonged  ollib  at  a  constant  rate,  a  similar  run 
la  illustrated  In  Figures  g  and  g,  with  a  height  rate  of  only  50  ft  sec*1,  ao  that  the  ascent  to  80,000  ft  and  the 
subsequent  desoent  each  lasted  for  30  minutes.  This  reeults  in  a  considerable  inoreaee  in  the  variances  of  the 
inertial  system  ao  that  tha  affect  of  the  mean  value  of  8  (0.0b)  chons  ae  a  definite  systeeatlc  error  build-up 
on  both  velooity  (Fig.il  «nd  height  (Flg.8>.  It  diaonttretgg  a  vary  important  feature  of  tha  Kalman  filter, 

During  tho  olimb  the  erroneous  praaaure  height  changes  were  able  to  effeot  the  inertial  system  ae  th*  reHenoa  thet 
could  be  pieced  on  th*  latter  decreased.  However,  th*  Kalman  flltar  build*  up  in  the  varieno*  matrix  a  ooopleta 
■at  of  correlations  in  th*  off-diegon»l  terae.  Thue,  on  regaining  leval  flight,  although  no  meaeurament  of  absolute 
height  li  aeds,  tha  filtar  is  not  only  abl*  to  correct  th*  inertial  velooity  error,  but  is  also  ebla  to  correct 
th*  height  error  which  had  arlewn  as  a  raault  of  thle  vaiocity  error. 

Figure  10  show*  th*  Kalman  flltar  aatiaata  of  S  ,  with  tha  trua  value  for  oomparleon,  during  th*  run  oorree- 
pouding  to  Flgurei  8  end  7. 


(.  CONCLUSION* 

Tha  Kalman  filter  can  provlda  a  uaaful  tool  for  th*  optimal  mixing  of  baro/in»rtl*l  height  information.  For  any 
praotloal  ayetea  it  la  eeaentlal  that  th#  form  of  th*  plant  and  aeaeureaent  noise  ahould  be  oarefully  studied  and 
mod* lied  a*  accurately  ts  poaaibl*.  It  ie  not  alaimed  that  th#  aymtea  described  above  is  optimieed.  but  it 
represents  a  uaaful  starting  point  for  tha  study  of  specific  air.oraft  eyeteaa. 
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CHAPTER  13  -  APPLICATION  OP  KALMAN  FILTERING  TO  THE 
c-s  guidance  anu  control  system 

Stanley  P. Schmidt,  John  D, Weinberg  and  John  S.  Lukeeh 


I.  INTRODUCTION 

Thn  Inertia] -floppier  Navigation  System  developed  by  Northrop  for  the  USAF/Ioekhood  C-S  heavy  logistics 
transport1  Is  designed  to  provide  an  accuracy  sufficient  for  dropping  supplies  and/or  personnel  at  desired 
loeationa,  in  any  kind  of  aaathar,  anywhere  on  earth.  The  requirements  of  high  acouracy  and  all-weather  capa¬ 
bility  are  satisfied  by  combining  information  from  aelf-contalned  and  ground-based  navigation  aids.  The 
measurements  from  the  navigation  aids  are  prooestad  by  the  on-board  navigational  computar  which  uaaa  algorithms 
derived  from  Kalman  filter  theory9, 

This  adapter  describes  the  development  of  the  Kalman  filter  as  utilized  in  the  on-board  ctsnputer  of  the  C-S 
navigation  system.  The  itlman  filter  development  in  Itself  represents  only  a  small  part  of  the  overall  system 
developaent,  To  eld  in  an  understanding  of  the  practical  problems  associated  with  application  of  the  filter 
theory,  considerable  relevant  Information  on  i.he  overall  navigation  system  has  been  included.  The  diacuielon 
proceeds  In  eubetantlal’y  the  ease  order  in  ehioh  the  actual  nohanlzatlon  algorithms  ears  developed:  (a)  System 
Description,  Problea  Definition  and  Approach:  (b)  Design  Development  and  Description;  and  (c)  Design  Evaluation 
J  Refinement, 

Suction  2  diecuisoe  the  conceptual  design  of  the  overall  navigation  system,  describes  the  ayetem  components, 
deflnss  the  aretes* t  functional  capabilities  and  accuracy  requirements,  and  discusses  the  development  approach 
to  the  Kalman  filter. 

Section  3  formulates  the  mathematical  bangs  for  tha  .design  and  for  tba  arrer  avaluatlon  programs.  Thmra 
felloe*  a  dlmcusslon  of  (a)  the  major  constraints  that  stra  imposed  on  the  design  by  tha  hardware  implementation, 
(b)  tha  alternate  design  eolutlona  that  verm  cooaiderid  and  evaluated,  and  (o)  the  final  solutions  adopted.  At 
tha  ocmpUtlon  of  this  phase,  design  definition  was  sufficiently  coaplata  far  the  detailed  real-time  programming 
of  tha  computer  to  bagln. 

nit  “Deals n  Evaluation  and  Refinement"  phase  (Section  4)  required  a  detailed  simulation  program  to  validate 
the  design  end  to  develop  refinements  in  problem  arses.  Because  sitsnslvs  system  laboratory  teats  and  soma  systaa 
flight  testa  had  already  been  conducted  at  the  time  or  erlting,  it  has  been  poaal.ile  to  include  in  thle  section 
some  comparative  reault.s  between  elmulated  end  real  aystem  behavior.  Those  comparisons  demonstrate  the  per¬ 
formance  capability  of  the  design,  and  also  show  bow  the  simulstor  was  used  to  locste  and  correct  trouble  areas. 

Section  5  le  a  brief  auaasrs  of  the  overall  C-9  Kalman  navigation  filter  development  effort  described  in  the 
earlier  sect lone. 

finally,  section  8  takes  a  brief  glance  at  future  trends  in  the  area  of  Kalman  filtering  application  to  real- 
tias,  digital  computer  Implementation  of  augmented  inertial  and  other  types  of  navigational  systems. 


I.  SYSTEM  DESCRIPTION.  PPORLtM  DEFINITION  AND  APPROACH 

Development  of  the  Kalman  filter  for  tba  C-J  navigation  syetem  started  with  tba  follosing  areas  already  more 
or  lees  completely  defined: 

(1)  lbs  functional  design  of  the  overall  navigation  oyatam. 

(11)  Tba  functional  capabilities  and  accuracy  goala  necessary  to  satisfy  tba  various  C-S  mission  requirement*. 

(ill)  Tbs  detailed  specifications  on  the  performance  chareeteriwtiee  of  tbs  various  subsystems. 

r-«  central  objective  was  to  davalop  the  algorithm  to  be  ueed  in  the  on-board  computer  which  would  enable 
the  achievement  of  these  functional  and  accuracy  capabilities.  Pursuit  or  this  objective  involved  such  attention 
to  mathematical  error  models  -  both  functional  and  statiatical  -  of  all  of  the  subsystems.  The  constraints  of 
oa-board  computer  memory,  word  lnngth,  und  speed  sere  tleo  of  fundamental  importanca. 

Tbit  section  praaanta:  (a)  a  few  fundamental  concepts  on  insrtlal  systsas  and  the  Kelson  filter;  (b)  a  descrip¬ 
tion  of  the  overall  aystem  configuration,  sufficiently  detailed  for  the  — :J-r  to  underatand  the  role  of  the 
Xalaan  filter;  (c)  a  description  of  the  overall  system  design  rarsilrements  and  goals;  snd  (d)  a  definition  of 
tha  problem  and  a  description  of  the  approach  edqptt'l. U'-th* .  WM"  filter  development.  #  ,  , 

.fp  3M+  2 fit',. 
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*.  1  Fundamental  Concepts 

A*  *111  be  seen,  the  C-8  navigation  system  In  It*  primary  modes  of  operation  usee  an  lnerti*l  monsuromont 
unit  to  maintain  *  continuous  knowledge  of  tho  position  snd  velocity  of  tho  aircraft.  It  will  also  bn  soon  that 
tho  Kalman  filter  is  usod  to  update  tho  inertial  navigation  system  when  data  from  other  navigation  aids  in 
available. 

The  following  is  a  brief  description  of  the  fundamentals  of  inertial  navigation  systems  and  tho  praot.ical  appli¬ 
cation  of  Kalman  filter  theory  to  them. 

2.1.1  Inertial  Navigation  System* 

figure  i  ie  a  highly  simplified  block  diagram  illustrating  tho  fundamental  operation  of  an  inertial  navigation 
system.  Tho  principal  components,  tho  inertial  measurement  unit  (IMU)  and  the  computer  are  thorn. 

Tho  IMU  contains  a  stable  platform  on  which  three  gyros  and  threo  linenr  accelerometers  arc  orthogonally 
mounted.  Ae  implied  by  its  name,  tho  stable  platform  maintains  an  orientation,  commanded  by  the  computer,  which 
is  independent  of  the  orlontatlon  of  the  esse.  Tills  1b  occomplishod,  as  indicated  in  Flguro  1,  by  sensing  error 
signals  from  the  gyro  output  axis  pick-offs  and,  through  feedback,  hy  providing  the  appropriate  platform  drive 
nulling  torques.  This  "inner  loop”  feedback  oontrol  system  must  have  sufficient  gain  and  dynamic  response  to 
kssp  the  pick-off  errors  small,  regardless  of  IMU  case  attitude  motions. 

It  the  lnntr  loop  funotlons  properly,  then  the  platform  maintains  the  orientation  dictated  to  the  gyroe  by 
the  computer.  Each  gyro,  howover.  Is  not  a  perfect  device,  of  oourae,  and  tends  to  exhibit  a  small  "drift  rate". 
That  le,  even  when  the  gyro  output  sxls  pick-off  is  nulled,  the  gyro  osse  (fixed  to  the  platform)  hes  a  rotation 
rate  about  the  Input  axle  dlreotion  which  differs  slightly  from  the  commanded  rate, 

These  drift  rates,  and  the  unwanted  output  axil*  torques  which  attend  them,  arise  because  of  Internal  rota¬ 
tional  unbalances  In  the  gyro  about  Ha  output  axis,  gyro  output  axis  turquer  scale  factor  errors,  and  from 
sevoral  other,  more  subtle,  mechanisms.  If  the  oooputer  could  somehow  estimate  the  unwanted  output  axil  torques, 
then  their  effeot  on  platform  orientation  could  be  removed  by  spplylng  appropriate  angular  rate  compenset lng 
signals  to  ths  gyro  output  axis  torqmra.  ' 

Am  Indicated  In  Figura  1,  the  acoelsrometer  outputs  are  the  measured  epeolflo  foroe  which  Is  sent  to  the 
digital  computer  lb  the  form  of  pulse  trains.  The  specific  foroe  vector,  f  ,  le  given  am 

7  «  -  a  +  a  , 

where  *  le  the  inertial  acceleration  vector  and  0  le  the  gravitational  attraction  per  unit  masa.  If  ths 
position  la  known,  (J  can  be  calculated. 

Hsoos,  It  can  b*  seen  that  the  navigation  equation*  perform  the  functions  of  accepting  epeolflo  force  and 
performing  the  other  computations  necessary  so  that  poaltlon  and  veloolty  are  continuously  available. 

To  initialize  operation,  the  system  must  be  aligned  so  that  the  coordinate  frame  of  the  stable  platform  and 
computer  are  coincident.  The  Initial  position  and  velocity  must  also  be  known. 

The  Inertial  navlaatlon  equations  used  in  the  C-5  are  referred  to  as  a  wander  azimuth  geodetic  vertical 
mechanization.  Thin  mesne  that:  (a)  the  coordinate  frame  has  two  axes  in  the  looaily-level  tangent  plane,  and 
(b)  no  attempt  is  made  to  maintain  the  level  axes  in  a  preferred  azimuth  direction  (such  ts  north).  The  plat- 
fora  la  initially  aligned  by  driving  it  with  the  torquars  until  tb*  outpute  of  tbe  two  level  accelerometer*  are 
■sro.  Once  it  hae  thus  been  leveled,  its  azimuth  relative  to  north  ie  determined  by  monitoring  the  level  gyro 
command  rate*,  which  ars  necessary  to  kesp  It  level  despite  the  rotation  of  the  earth.  The  arc  tangent  of  the 
ratio  of  these  two  rates  then  provides  an  estimate  of  tho  platform  heading  relatlvrto  north.  Thle  operation 
is  called  eelf-gyrocompaeelng.  During  subsequent  operation,  position  and  velocity  data  are  coaputed  and  applied 
through  the  gyro  torquere  to  aalntaln  the  platform  looaily-level  despite  aircraft  aotion  across  the  surface  of 
tbe  Earth. 


J.i.J  Kalman  Filter  Theory 

Because  of  the  verlous  error  touross  in  gyros,  accelerometers,  the  initialization  procees,  snd  navigation 
equation  approximations,  the  position  end  velocity  indicated  by  the  inertial  navigation  eyetem  is  in  error. 

The  error  also  grows  with  tims  after  Initialization. 

Data  which  art  functionally  related  to  the  true  aircraft  position  and  velocity  can  alio  be  obtained  from 
wany  other  sources.  As  sxaaples,  barometric  pressure  provides  an  indication  of  altitude,  Doppler  rider  provides 


*  Deference  3  is  highly  recommended  for  those  deairlng  further  information. 

*  lb*  output  ails  of  s  slnele-degree-or-freedea  gyroecope  le  that  axis  (noraal  to  the  spin  sxls)  about  which  the  epinniug 
rotor  ie  free  to  rotate  with  reaped  to  the  syro  osse.  The  input  tala  (normal  to  the  spin  snd  output  sees)  is  therefor* 
the  direction  about  ebleh  the  gyro  Is  sensitive  to  rotational  case  Motion  with  respect  to  Inertial  space. 


i  manure  of  ground  spend,  and  no  forth.  Conceptually,  It  li  doilred  to  uie  this  external  data  to  update  the 
inertial  navigation  system;  unfortunately  these  data,  too,  are  imporfnct,  because  of  meanurenent  errors  and 
other  effcota  (a. g. ,  the  preesure-altltudo  relationship  is  nan- constant). 

Kalman  filter  theory  provides  a  means  by  which  algorithms  con  bo  derived  for  digital  compute-  proceaslng  of 
suoh  isasuroment  data  observations'.  The  resultant  algorithms  are  feasible  for  use  with  on-board  computers  In 
that  there  la  no  requirement  for  storage  of  largo  quantities  of  data;  that  is,  each  observation  is  processed 
sequentially  as  it  occurs  in  tlmo,  and  after  it  le  processed  the  raw  datt  can  be  overwritten  with  new  data.  Ar 
originally  presented,  the  Kalman  algorithms  were  restricted  to: 

(S)  Linear  dynamic  systems, 

(b)  Observstions  linearly  related  to  the  state  vector, 

(o)  Obeervetlone  ocourrlng  at  squally  spacud  tine  Intervals. 

The  praotiaal1  application  of  the  theory  requires  removal  of  these  throe  restrictions.  Removal  of  the  third 
restriction  Is  trivial  and  Is  readily  accomplished  by  stating  the  original  algorithm  given  hy  Kalman  In  the  two 

parts: 

(1)  at  an  observation; 

(2)  between  successive  observations, 

Tbsoretioal  proof!  which  remove  the  first  two  restrictions  for  nonlinssr  systami  art  not  available.  Practl- 
oally,  howevor,  one  should  recognize  that  almost  all  real  systems  obey  approximately  linear  relationships  in 
the  Vicinity  of  a  given  solution.  Aa  a  result,  a  practical  filter  for  nonlinear  systems  oan  bo  derived  by  eppro- 
priats  use  of  variational  equations  about  a  solution  whioh  la  “oloao  to"  the  desired  solution,  The  desired 
solution  in  the  otae  at  hand  would  be  the  true  value  of  the  navigation  itate  vector  (alroraft  position,  velocity, 
•to.)  which  the  observations  are  used  to  estimate.  If  this  solution  wtra  known  there  would  be  no  notd  far  the 
filter.  Hence,  since  it  la  not,  the  must  obvious  second  aholat  Is  linearization  shout  the  beat  aitlmste  of  the 
navigation  state  vector,  which  la  Indeed  available,  if  the  aolution  converges  an  moru  obaarvationa  are  taken, 
the  linearization  approximation  becomes  more  and  more  valid. 

The  algorithm*  are  presented  here  In  one  of  the  many  form*  whioh  are  applicable  to  a  general  nonlinear 
problem".  Tallowing  thla,  the  overall  Implementation  of  the  flltor  In  the  C-fl  navigation  eyetera  le  dieoueeed. 

aiven  a  myites  which  obeye  the  differential  equations 

Z  =  H(Z,'U,p,t>  ,  (2.1) 

where 

Z  =  normally  defined  state  vector; 

U  i  veotor  of  forcing  functions;  U  may  be  compoeed  of  known  funotione  of  time  and/or  random 
functions  of  time; 

p  =  veotor  of  constants  whose  values  are  required  to  give  a  unique  set  of  Equations  (2, 1). 

The  veotor  observations  of  this  system  obey 

Y(t)  =  S(Z,  V,  t)  +  q(t)  ,  (2.2) 

where 

V  =  a  vector  of  deterministic  quantities  (e.g. ,  oonsts-ts)  necessmry  to  uniquely  define  the  equations: 
q(t)  a  random,  time-unoorrelated  errors  of  observation ,t. 


An  augmented  state  veotor  X  can  now  be  constructed,  vim, : 


•  The  word  olwervation  is  choeen  here  to  indicate  t  meaeuresent  used  In  the  tepee  of  lefertnot  2,  Thla  dletlnetion  i* 


mode  because  cot  all  leaauresents  era  prncasasd  In  this  aanat,  as  (111  be  seen  later. 

*  The  firet  kaowo  etudy  reeulte  of  t  preotioal  application  of  the  filter  ere  liven  In  Inference  4, 

"  Several  fores  ere  presented  in  Reference  B, 

((  Any  tlse-oorrelsted  eeeeureaent  error*  cen  be  defined  as  oueponents  of  V  ,  Thla  alao  requires  definition  of  differ¬ 
ential  equations  fnr  these  component*  with  white  noise  type  drlvlne  funotione. 

•••  These  techniques  are  presented  In  sore  detell  l*  Reference  9,  nlthouah  the  notation  there  le  somewhat  different. 


aoa 

than  ; 

u(t)  =  Whit*  naiu  (random  forcing  functions). 

Alio. 

Y(t)  »  G(X, t)  +  q(t>  .  <2.0 


S,  1,3  Modlfitd  Kalman  Filtir  Equation! 

Th*  modified  Kslasn  (liter  (or  tuch  a  eystem  tnd  it*  observations  1*  eiimsrUed  by  Equation*  (2,5)  -  (2.11), 
(or  which  tha  following  definition*  and  sssinptlons  apply: 

(a)  9,()  1,,,^  denote*  the  gradient  of  th*  braokntad  function  evaluated  at  1  =  1. 

(b)  t  denote*  the  observation  time,  t0  denotes  the  tine  of  tho  last  change  in  tho  estimated  state  (which 
coincide*  with  the  time  of  the  last  observation). 

(o)  The  subscript  a  donotes  "after  the  observation  is  included"  and  the  subscript  b  denotes  “before  tho 
obaorvstion  ie  lncludod".  Honco,  from  Equation  (2.7),  at  an  observation  tine,  Pb  -  P(tB)  ,  and  P0  In 
Equation  (2.2)  becomes  P(t0)  in  Equation  (2.7)  when  updating  to  the  next  observation  time.  Further 
o ooiments  (regarding  multiple  observations  occurring  at  the  same  time)  are  included  in  th*  subsequent 
dlsoussion. 


Between  obiirvationt  (time  update) 

i((t)  =  fl(t0)  +  I*  F(X,t)  dr  (8-8) 

ha 

s  ■  . ta*«V«W  ■  >  «••> 

♦  % 


♦  % 

At  observation  tint,  tB  (observation  update) 

P(tB)  «  «(t,;ta)P(t(1)«T(t.;t0)  +  *(tB;t()  (2.7) 

i(tB)  «  <«,+«,>  (Y<tB>  -f(t,)]  (2,«) 

VV  *  Pb  -  K,»b  +  K.dlP^  +  OK]  (2,») 

"!(tB+T)  *  *(tB+T!  tB)i(tB>  (2.10) 

it(tBtT)  a  Xb(tB+7-)  +X(tB+T)  ,  (2.11) 


Equation  (2,5)  simply  represents  an  integration  of  th*  differential  equations, 

X  s  F(X,t)  , 

using  i(t5)  as  Initial  condition*.  fi(t)  is  th*  best  estimate  of  X(t)  ,  beoaues  th*  random  funotion  u(t) 
of  Equation  (2.3)  is  a  aero  mean  whit*  noise  verltbl*. 


Equation  (2.8)  define*  th*  differential  equetion*  for  th*  transition  satrli,  which  relate*  email  deviations 
in  X(t0)  to  small  dsvlationa  in  X( t)  ,  that  is, 


<Kt:t0)  * 


W(t) 
s«t0)  * 


By  daflning 


I  «  X  -  X  , 


than,  approximately, 

x(t>  =  t(t; t,)x(t0)  +  f*  t(t;T)u(T)  dr. 

*e 

Henoe,  defining  th*  ooverienc*  matrix  P(t0)  by 

P(t,)  a  lG(t,)?(t()]  . 

share  l[]  mesne  th*  expected  veiu*  of  th*  bracketed  quantity,  and  uning  th*  whit*  nole*  definition  of  th* 
rtndaa  Ysjisblts,  u  .  It  follows  that: 

*  P(tB)  »  |[I(tB)iT(tJ|)]  *  Equation  (2.7)  . 
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IKt,,;  t0)  in  Equation  (3,7)  la  the  randan  uncertainty  in  tho  itate  caused  by  th*  random  variable'  u  . 

Equation  (3.8)  define*  the  ohsnge  In  tho  etete  eetlmate  reaultlnc  from  the  observation,  and  Equation  (2.9) 
updates  the  covarlanoe  matrix  P  to  include  tho  effects  of  the  observation. 

In  these  equations: 

V(tB)  s  aotuui  observation 

^(t,)  =  G(X,  ta)  -  computed  (estimated)  observation 

Y(ta)  -  9(t#)  =  obeorvatlon  residual 
Kj  =  P^T/(MPbMT  +  C) 

One  footnote 

K,  =  MT«/(MPbMT  +  C) 

M  c  V„[a(X,t.)]|  . 

x  ■  I x-8 

<  =  control  isitt  of  epeilon  technique 

0  *  ECq(t.)qT(t1)]  . 

The  equations  are  for  a  single  observation,  that  la,  each  observation  type  is  sequentially  processed.  K  is 
the  conventional  gain  for  the  Kalman  linoar  filter,  K}  represents  on*  type  of  fix  [sec  References  7  and  8J  for 
preventing  divergence  of  the  filter  resulting  from  unmodslad  and  computational  errors.  In  this  ohapter,  the  use 
of  K,  la,  called  the  "epsilon"  technique, 

K,  causes  overweighting  of  the  most  recent  observation  in  Equation  (2.9).  This,  in  turn,  causes  an  additive 
growth  of  the  covarlanoe  matrix  In  Equation  (2.9), 

Because  of  tho  computation  time  required  to  carry  out  the  ealoulationa,  i(ta)  lu  only  available  after  a 
aaall  delay.  Equation  (2. 10)  therefor*  predicts  x(ta)  ahead  to  time  tR  +  r  ,  where  t  la  larger  than  the 
caaputatlon  title.  When  real-time  reaches  t  +  r  ,  Equation  (2.11)  is  used  bo  modify  the  total  ayaten  state 
estimate, 


fl 


2.1.4  C-.5  Navigation  Syittm  Coni idarnt ions 

Proa  th*  preceding  discussion  on  fundamentals  of  Inertial  navigation  aystama,  a  mathod  of  implamantlng  the 
Kalman  tiltar  in  a  navigation  system  can  be  recognised.  This  is  to  use  the  basic  lnsrtisl  navigation  system 
in  the  role  of  solving  Equation  (2.  8).  To  faailltits  this,  the  components  of  the  state  vsotor  X(t)  were 
chosen  to  include  quantities  (auoh  as  position  and  velocity),  sttlmatas  of  which  trs  carried  In  the  digital 
computer  registers.  Also  Included  are  the  attitude  of  the  Inertial  platform  of  ths  IMU,  gyro  drift  rstss, 
socslsroaster  biases,  msssuremsnt  srrors,  and  so  on.  This  sugmsntsd  stats  vsotor  then  contains  til  ths  quanti¬ 
ties  nsoissiry  for  describing  the  -<vnsmio  respone*  or  the  real  system  for  given  initial  oonditione. 

The  u(t)  of  Equation  (2.3)  oan  be  Interpreted  ta  random  forcing  functions  In  the  Inertial  system  or  In  the 
measurement  device*  which  privent  perfect  time  updating,  Physical  evidence  has  shown  that  gyros  and  msny  other 
rati  devices  have  errors  which  very  with  time  end/or  other  environmental  factors.  Hsnce,  this  random  forcing 
function  concept  provides  n  wane  of  lnoluding  auoh  eftsots  in  tho  filter  algorithms. 

Figure  2  ie  a  block  diagram  depicting  th*  conceptual  rial-tin*  Implementation  of  a  Kalmen  filter,  In  aocordano. 
with  the  above  etendpolnt,  In  to  on-board  navigation  computer.  In  particular,  th*  sequence  of  operations  Involved 
In  a  alngle  cycle  of  th*  on-board  filter  Is  shown.  Although  th*  figure  la  largely  eelf -explanatory,  It  should 
be  noted  that  oareful  attention  to  nequenolng  then*  operation!,  so  an  to  minimis*  or  eliminate  poneible  harmful 
control  lags,  li  Inherent  In  the  dltgrea. 

Details  of  tha  Kalman  filter  which  li  mechanised  In  the  C-9  navigation  ityntam  are  dlscumed  In  Inter  eeotlone. 
I. I  Navigation  Syntwa  Description 

Tha  C-S  navigation  ayaten  conalata  of  the  Inertlal-Doppler  Navigation  Equipment  ( I WE)  end  a  number  of  auxili¬ 
ary  navigation  aids,  manufactured  by  several  aub- contractor*.  Northrop  Electronic*  Division  la  the  system 
Integrator  «•  well  ta  tha  supplier  of  major  equipment  items,  lnoluding  the  IMU  end  the  on-board  digital  computers. 
Figure  3  le  a  simplified  block  diagram  of  th*  system*.  Aa  shown  In  the  blook  diagram,  a  high  degree  of  redund¬ 
ancy  wan  Incorporated  In  the  design  to  enhance  overall  reliability.  Tha  two  on-board  digital  computers  are  the 
heart  of  the  baaio  system,  Th*  navigator's  control  and  Indicator  panels  entble  him  to  decide  whet  mode  to  select, 
whit  navigation  information  to  use  or  reject,  and  ao  forth. 

Feetfutw:  Tbw  aaaaurawwnt  dimension  le  eweumwd  her*  to  bw  1  a  1.  tblw  allows  uiw  of  scalar  division,  rathar  then  tha  watrlx 
Invaraion  raqulrad  In  the  mors  general  cast  of  an  sal  measuremant. 

*  tafersne*  1  glvas  soma  additional  datatla. 
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Thi  Digital  Computer 

Thi  computers  ahown  In  Figure  3  are  Northrop  Eleotronlci  Division  goneral-purpoio,  parallel  operation  digital 
computers  (NDC-1081A),  The  word  length  ia  23  bite.  The  memory  *Uor  aro  12,288  and  8,192  words,  respectively, 
for  tho  primary  and  auxiliary  computers.  Other  characteristics  are  as  follows: 


Memory  type: 

Random  access  core,  non-volatile  DRO 

Instructions: 

81,  with  two  Instructions  per  word  and 
arithmetic  capabilities 

Add  time: 

Half-word  6  mioroaeoonda 

Full-word  8  microseconds 

Multiply  tine: 

Half-word  23  inicroieconda 

Pull-word  H  microiacondi 

Indexing 

Other  fsaturaa: 

Indirect  addressing 

Roll  table  (puah-down  ataok) 

Interrupt  capability. 

Tht  MV 

The  IMU  (Inertial  Measurement  Unit),  ahum  In  Figure  3,  la  the  Northrop  floated  ball,  glmballesa  platform. 

Three  Northrop  single-degree- of- freedom  floated,  rate- Integrating  gyroscopes  are  orthogonally  mounted  inside 
tha  floated  ball.  Each  gyro  error  signal  la  detected  and  amplified.  Die  amplified  signals  are  applied  to  ball- 
mounted  torque re  which  oaust  the  hall  to  rotato.  This  hlgh-gain,  three-axis,  feedback  attitude  control  system 
rotatlonally  laolataa  the  floated  ball  from  the  case,  maintaining  a  atable  platform  to  a  high  degree  or  aoouracy, 
Each  gyro  has  an  input  torquer  whoea  command  signals  are  controlled  by  the  digital  aomputer.  Hence,  the  platform 
attitude  relative  to  a  given  reference  frame  oan  bo  changed  by  quantities  computed  by  tho  digital  computer. 

Three  Kearfott  linear  pendulous  accelerometers  are  also  orthogonally  mounted  Inside  the  floated  Inner  ball. 

The  aooelerometer-eenaed  signals  are  sent  to  tha  digital  ooeiputar  in  tha  form  of  a  train  of  pulses,  The  number 
of  puleee  In  a  given' unit  of  time  divided  by  the  time  interval  la  a  measure  of  the  average  specific  Toroe  exerted 
on  the  IMU  otee  over  the  interval.  The  frequenoy  of  the  pulaea  for  the  C-8  eyetim  i«  high  enough  for  thla 
av erega  aptolflo  foroe  to  be  considered  aa  a  oontinuoua  quantity,  for  all  praotloal  purposes. 

The  IMU  also  contain!  an  electrostatic,  three-axis,  spherical  angle  measuring  system.  This  “ball  readout" 
provldea  a  measure  of  the  orientation  of  the  platform  ossa  (outer  bull)  relative  to  the  etable  member  (inner  ball). 

Doppler  Radar 

Tha  Doppler  radar,  manufactured  by  tha  dPL  Division  of  Oensral  Precision  Systems,  Ino. ,  supplies  tbe  computer 
with  measurements  of  ground  apead  and  drift  angla*.  B y  utilizing  information  from  the  “ball  readout"  mentlonad 
previously,  it  ia  poaeiblt  to  obtain  tha  ground  speed  relative  to  platform  axes. 


LORAN 

Tha  DORAN  raoalver  la  aanufaoturad  by  Collin*  Radio  Company.  *hen  avallabla,  the  LORAN  data  ia  converted  by 
the  digital  computer  to  position  lnformetlon  and  displayed  to  the  navigator.  Subject  to  his  judgment  and  oontrol, 
tha  LORAN  date  can  also  ba  used  to  update  the  beat  estimate  of  the  state  vector  whioh  Include*  position,  velocity, 
and  other  quantities,  ■ 

TACAN 

The  TACAN  receiver*,  manufactured  by  Hoffman  Electronics,  provide  elent  range  and  bearing  information  to 
ground  atatlona  at  known  looationa,  Tha  navigator  can'uae  thla  data,  when  it  1*  uvellable,  In  a  similar  manner 
to  that  deaorlbtd  for  tbe  LORAN, 

KuIti-ao.il  Radar  (Ml) 

The  multi-mode  rmdar,  manufactured  by  Norden  Division  of  United  Aircraft,  provides  aany  sodas  of  operation 
for  tha  C-8.  Two  sodas  art  uaad  to  obtain  navigation  Information.  In  the  terminal  phase  of  flight,  the  navi¬ 
gator  oen,  through  a  oetbode  riy  tub*  display,  sight  on  landmark  pattern*  whoaa  position  relative  to  deaired 
supply  snd/or  personnsl  drop  location  la  known,  Slant  rang*  and  bearing  data  is  providad  tv  tha  WR  during  the 
terminal  phai*.  Tha  navigator  oan  alio  uaa  the  MMR  for  sighting  on  landmarks  whole  abeolut*  poaltlon  (latitude 
■id  longitude)  are  known.  In  thla  sod*  th*  aeaaurenant*  of  raan,  bearing,  and  landmark  location  go  direotly 
to  tha  Kelaao  filter. 


Attitude-Heading  Reference  Unit  (AMI) 

Til*  two  redundant  attitude  md  heading  reference  unite,  ahown  in  Figure  3,  are  manufactured  hy  Lear  Sloglur. 
Data  free  theae  unite  la  uied  to  provide  a  back-up  mode  of  operation  in  oaae  of  an  1HU  malfunction. 

Central  Air  Data  Computer  ( CADC ) 

The  two  air  data  computers  are  manufactured  by  Elliot  Brothara.  One  of  the  funotiona  of  the  CADC  ia  to 
provide  barometric  preaaure  altitude  data  to  the  navigation  ayatem.  (Sco  Reference  1  far  other  tunotlonn. ) 

Inertial-Doppler  iVavi/ation  Equipment 

Figure  4  la  a  functional  block  diagram  of  the  C-B  Inertia) -Doppler  Navigation  Equipment,  which  pertorma  the 
navigation  function  in  the  primary  mode  of  operation,  Thla  major  aubayatem  of  the  navigation  ayatesi  la  aupplled 
by  Northrop  Elaotronioa  Dlvinlon,  It  oontalna  elements  organized  and  located  aa  ahown  In  Figure  4,  The  Ekjppler 
antenna  and  IMU  ars  In  the  noaa  vlaor  of  tha  aircraft,  The  wlaotronica  rack  oontalna  the  A-D/D-A  (analog-to- 
dlgltal  and  dlgltal-to-analog)  oonvertera,  the  digital  computera,  and  the  Dopplar  algnal  data  converter.  The 
control  and  indlostor  tinnala  are  In  the  navigator'  a  area. 

Befora  installation  In  tha  alroraft,  a  tape  reader,  which  ia  part  of  tha  auxiliary  ground  equipment,  le  used 
to  load  tha  raal-tlms  computer  program  and  aaaoelattd  corstanta  into  the  memory  of  tho  primary  and/or  auxiliary 
computer.  The  navigator  aleo  haa  aocsss  to  soma  parts  of  tha  computer  namory  through  a  keyboard  Input. 

1.3  Navigation  Syatam  Functional  Capabilltlat  and  Aoouraoy  Ooalt 

2 .3.1  Syeten  Operating  Model 

Am  aaa  bs.aesn  froo  tha  diaouaelon  ralatlva  to  Figure  3,  tha  C-B  navigation  eyetem  haa  munaroua  aquipmant 
radtudanoiefl  to  anhanct  overall  ayatem  reliability.  Ip  addition,  tha  navigator  can  aalaot  any  one  of  four  bnalo 
navigation  model,  depending  upon  equipment  availability,  A  brief  description  or  these  primary  mode  a  la  now 
(Ivan. 

Free  Inertial  ThJeaode  uaea  the  IMU,  digital  computar,  and  barometric  pleasure  measurement*  of  altitude. 

Doppler-Inertial  This  mode  adds  tha  Dopplar  measurements  to  theme  used  In  tha  fraa-inartlal  mode, 

Doppler  Dead- Reckoning  In  oaae  of  IMU  failure.  It  the  Dopplar  and  AHRU  equipments  ora  available,  thla 
-■ode  oon  be  selected, 

True  Airepeed  Uead-Reckonlnc  It  both  tha  IMU  and  the  Doppler  radar  fall.  AHRU  and  airspeed  data  from  tha 
CADC  oan  be  ueed  to  oontlnu*  dead  reckoning,  ' 

in  any  one  of  thtie  heilc  model,  politico  data  from  IORAN,  TACAN,  multi-mode  radar,  or  viaual  Information 
oan  tlno  be  ueed  to  update  the|  beet  eitlmate  of  the  etnte  viator. 

In  .addition  to  theae  navigation  model,  therv  are  alao  the  platfora  alignment  (ground  or  air)  model.  Hara, 
aa  In  tha  navlgatloh  modes,  tha  Kalman  filter  la  ueed  for  weighting  the  virloue  available  data  to  continually 
opt  lain  navigation  and  platform  alignment, 

Finally,  a  special  terminal  navigation  mods  uies  muUi-moda  radai  data  to  attain  the  high  relative-position 
aoouraoy  required  for  detaralning  tha  computed  air  release  point  (CAR?)  In  onrgo  or  peraonnal  drops. 

2.3.2  IDNE  Performance  Goal* 

The  design  performance  goals  for  tha  C-S  navigation  ayatem  are  those  defined  for  syetem  Initialization  and 
navigation  In  tha  Doppler- Inertial  and  fret- inertial  model .  aa  follows.  > 

(a)  Ground  alignment  (-78°  to  +78°  latitude):  t 

(1)  Warm-up  troa  -85°F  end  alignment  after  warm-up,  both  In  2B  minutes. 

(3)  Initial  position  uncertainty:  1.0  nautical  mile  <3cr). 

(b)  Airborne  alignment  (-78°  to  +78°  latitude): 

(1)  Alignment  after  warm-up  in  20  minutes. 

(3)  Initial  position  uncertainty:  8.0  nautical  milm  (3cr). 

(o)  Navigation  (frae-lntrtiol  and  Dopplar-lnartlal) : 

,  (1)  Around  alignment  -  first  8  hour*:  0.78  nautical  alia  per  hour  CEP, 

-  teoond  8  hour*:  1.28  nautical  miles  per  hour  CEP. 

(3)  Airborne  alignment  -  first  8  hours:  1.0  nautical  alls  per  hour  03*, 

-  aocond  8  hour*  :  2.0  nautical  ailan  per  hour  CO1, 
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Thiu  design  goals  art  explained  as  follow*.  The  eyetom  should  be  able  to  be  aligned  within  35  minutes  from 
cold  atart  (•65°K)  at  latitude*  -75°  to  +75°,  even  when  the  initial  location  la  not  known  to  better  than  a  1 
nautical  mile  (3o)  tolerance, 

following  ground  alignment,  the  ensemble  poeitlun  error  growth  rate  should  bo  no  largor  then  0,75  nautical 
mile  por  hour  OT*  for  tho  first  five  hours  and  1,25  nautical  miles  per  hour  CEP  for  the  second  five  hours,  for 
either  th*  Doppler-Inertial  or  tho  free-lnertlal  mode,  following  air  alignments,  the  corresponding  goala  are 
1,0  and  2,0  nautical  miles  por  hour,  even  with  a  5  nautical  mile  (3 a)  initial  position  uncertainty. 

The  free-lnertlal  mode  performance  goals  are,  of  oourso,  the  more  stringent.  That  is,  Doppler  data  provide* 
added  ■aasursmonte  which,  If  proptnly  used,  must  Improve  tho  syetem  performance  over  that  obtained  with  the 
free-lnertlal  mode, 

Obviously,  the  operational  environment  for  ground  alignment,  is  far  more  severe  thun  a  laboratory  environment. 
The  C-S  is  a  heavy  logistics  transport  end  tho  1MU  and  other  equipment  are  located  in  tho  nose  visor.  The  nose 
visor  in  open  while  the  eiroraft  is  loading  cargo*.  Tho  ground  alignment  process  must  be  carried  out  during 
visor  motions  created  by  winds  and  oargo-loading  transients.  Definitions  of  approximate,  but  realistic,  statisti¬ 
cal  models  for  such  factors  were  required  during  tho  Kalman  filter  development  effort. 

7.3.3  .Scheduling  Acquirement! 

An  unusually  stringent  aohedule  was  maintained  on  the  antlra  C-5  program  by  Lockheed,  Northrop,  and  th*  other 
equipment  suppliers,  For  that  reason,  whan  considering  verious  system  rofinsmsnts  in  which  a  number  of  alterna- 
tlvas  presented  themselves,  decision  deadlines  had  to  be  mut,  sometime*  requiring  s  less  thorough  than  dsslred 
♦valuation  of  taoh  alternative, 

5.4  Problem  gauntry  and  Approach 

Th*  C-6  Kalman  filter  development  problem  oan  be  lummirlzed  at  follows. 

Given,1  ('a'  Performance  specifications  end  phyeloal  charactsriatloi  of  tho  C-5  subsystem  hardware. 

(b)  Required  overall  C-5  syetem  functional  capabilities  end  performance  goals, 


De/ine; 


The  algorithms  for  the  Kalman  filter  portion  of  tha  real-time  program,  and  all  interfaces  with  other 
sub-programs  of  th*  computer, 


A  logical  first  question  was:  “doe*  e  solution  exist?".  At  the  start  of  the  problem,  relevant  Information 
from  many  eourota  (such  u  preotloal  experience  and  data  from  conventional  Inertial  navigation  ayatema)  was 
available.  Theoretical  conalderatione,  preliminary  analyaia,  and  praotloal  txpsrlsnce  all  oontrlbutad  to  give 
a  high  degree  of  oonfldeuoe  that  a  eolutlon  must  axlat.  In  fact,  aa  will  be  seen  later,  probably  many  alterna¬ 
tive  solutions  axilt,  Hence,  as  the  design  gradually  tvolvtd,  engineering  Judgment  played  a  large  role  In  the 
aelaotion  of  tha  apacUia  solution  from  ths  available  alternative*. 

In  solving  a  problem  of  this  type,  It  Is  loglotl  to  first  ask.  four  primary  questions: 

(1)  What  is  known  about  the  problem? 

(2)  that  sddltlonel  information  must  b*  obtained? 

(3)  How  Is  this  additional  Information  to  Is  obtained’ 

(4)  Can  th*  generation  of  this  information  be  organized  so  that  It  la  available  when  needed? 

The  answers  to  question  (1)  ere  summarized  in  th*  paragraph  above,  and  th*  other  questions  are  discussed  below. 
Note  that  answer*  to  question  <31  are  ths  aolutlone  to  th*  problem*  rosed  Implicitly  by  question  (2).  Ths 
answer  to  'question  (4)  Is  really  the  approach  to  solving  th*  overall  problem.  That  le,  the  overall  problem  is 
asperated  Into  many  amall  problems,  the  solutions  of  which  trs  organized  to  provide  s  logical  time  sequence  of 
overall  ayatem  development.  Typical  problems  end  eolutlon  approaches  involved  in  the  C-5  Kalsan  filter  design 
development  ere  Illustrated  In  th*  fol lowing  paragraphs. 

Sump  It  t 

Preliminary  etatlatlcal  information  sae  nueded  on  ayatem  performance  in  it*  prinolpl*  ttodee  of  operation 
(e.g. ,  Doppler-inertial  navigation  following  a  ground  alignment).  Adequete  atatletioal  error  analysis  technique* 
for  linear  systems  sere  already  available.  Further,  past  applications' had  shown  that  suoh  techniques  were 
explicable  tn  nonlinear  problems,  if  the  idea  of  a  nominal  trajectory  representing  the  mean  value  of  the  ensemble 
were  used.  Use  of  linear  varlatloml  equations  for  small  deviations  from  th*  nomlnsl  trajectory  therefore 
provided  th*  desired  linear  equations  for  propagating  and  relating  subsystem  and  ayatem  errors  for  C-5. 


*  The  09  (circular  error  probability)  usage  for  rateable  politico  error  eroeth  lw  Interpreted  si  aranlng  that,  for  an 
arbitrary  eyetea  selection  end  tent  evaluation,  the  probability  la  D.S  that  the  poeitlun  error  l*  lesi  than  the  specified 
number. 
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To  tin  thl*  theory  several  (tope  rare  required: 

(1)  Derivation  of  m  approximate  but  realletlo  mathematical  model  of  the  inertial  eyxteit. 

(3)  Derivation  of  variational  equation*  for  the  inertial  ayatem  error  model, 

(3)  Development  of  mubsyetsm  error  model*. 

(4)  Development  of  general-purpoao  digital  computer  protreat  for  calculating  ensemble  error  analysis  data. 

These  error  analysis  programs,  though  preliminary  in  some  respects,  must  be  sufficiently  flexible  to  enable 
Investigation  of  parformancu  senaitlvlty  to  maaiuremont  oyolin*  ratea,  non-lncluded  arror  eouroos,  and  the  like, 
Early  answers  to  questions  in  such  araaa  were  mandatory  to  allow  resaonably  accurate,  first-cut  asnsssment  of 
the  demands  which  the  final  Kalman  filter  program  would  hake  on  the  on-board  computer, 

Exanplt  1 

Information  was  needed  relating  the  number  of  state  variables  of  the  Kalman  flltsr  to  real-time  ooeiputer 
apeed  and  memory  requirements. 

Since,  given  the  algorithms,  an  uxperlenesd  rail-tine  programmer  can  estimate  time  and  memory  faotors,  this 
problam  was  solved  hy  out-and-try  procedures,  Initially,  "ball  park”  answers  were  found,  Thoie  lot  as  guldn- 
linei  until  new  information  requlrai  refinements.  As  described  in  Section  3,  suoh  data,  together  with  the  rasultu 
from  the  ensemble  error  analytic  programs,  Indicated  a  need  for  development  of  a  apeclal  data  amoothlng  algorithm 
for  the  raw  data,  beford  Kalman  filter  proaeeaing. 

E sample  3 

Information  wai  needed  about  auoh  nonlinaar  phenomena  as  the  build-up  ol’  computational  arror  in  the  on-board 
Kalman  solutiona.  No  known  theory  could  provide  anawers  to  *uoh  quaations.  Simulation  of  the  system  on  a 
general -purpose  digital  oomputar,  however,  promlaed  a  very  practical  solution.  Konot.  davilopment  of  a  simulator 
and  study  of  auuh  affects  under  simulated  conditions  was  tho  aolution  ohoaen,  As  tha  design  evolved  prior  to 
laboratory  and  flight  testa,  tha  simulator  waa  expected  to  become  the  primary  tool  for  validation  and/or  oheoklna 
of  algorithm  reflnomenta,  If  the  simulator  design  were  made  sufficiently  voraatile,  it  would  also  hslp  in  under¬ 
standing  the  causes  of,  and  datarmining  fixes  for,  anomalistic  behavior  of  the  rial  hardware  in  later  atages  of 
tha  ayitn  development. 

These  are  a  few  examples  of  the  considerations  which  influancad  the  approach  to  th*  overall  problam  solution. 
Proa  the  thrae  axamples  givsn,  It  should  be  reasonably  obvious  that  tha  problems  could  not  all  be  solvnd  simul¬ 
taneously.  An  orderly,  tlme-mequonotd  approach  had  to  be  formulated  with  ovorlepe  in  obvious  areas,  and  with 
contlnganolea  for^redireotion  baaad  on  naw  information.'  Suoh  an  approach  adapted  itself  naturally  to  the  overell 
system  dsvelopmant  time  schedule,  Thu  sequenoe  of  presentation  in  the  next  two  sections  follows,  to  t  large 
degree,  tbs  overall  approach  adopted  by  Northrop  management  at  the  start  of  the  development  effort, 


3.  DESIGN  DEVELOPMENT  AND  DESCRIPTION 

The  previous  section  he*  briefly  dleoueeed  some  of  the  problems  whioh  hid  to  be  solved  in  the  development  of 
a  practical  C-S  Kalman  flltar.  The  moat  important  Initial  steps  war*  the  derivations  of: 

(a)  tha  eystem  state  veotor, 

(b)  dynamlo  equatloni  for  the  itate  victor, 

(o>  variational  equations  for  propag&tini  errors  in  the  state  vector, 

(d)  atatletloal  models  for  the  error  aouresa, 

furthermore,  a  general-purpose  computer  progrma  was  needed  early  for  evaluation  effaots  of  various  subaystam 
design  parameters  on  system  performance, 

As  data  waa  gathered  from  the  above  task*,  tbe  constraints  imposed  by  th*  limitations  of  the  roal-time 
oomputar  were  investigated.,  Thais  were: 

(m>  real-time  availability, 

(b)  computational  precision, 

(e)  memory  availability. 

This  station  follows  tha  nvarall  development  in  the  eequenoe  givsu,  and  auamarlzt*  the  design  algorithms  of 
tha  raal-tlaa  oomputar  that  resulted  from  this  phase  of  th*  development. 

3.1  Mathematical  Modeling 

The  general  definition  of  an  appropriate  mathematical  model  tor  a  real  ayatem  is  one  of  the  must  difficult 
tasks  in  tho  application  of  Kalman  niter  theory.  The  decision  ee  to  what  degree  of  approximation  is  appropriate 
la  primary,  alnco  unnecessary  complexity  will  result  in  unacceptable  real-time  ooeiputer  storage  and  eeaory 
requirements. 
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To  illuetratt,  consider  tho  problem  of  duflning  a  U-B  Byatent  atate  veotor.  Thu  primary  objective  of  th« 
navigation  »yst*m  1b  to  provide  continuous,  »ccur»te  Indication*  of  the  C-B  aircraft  position,  velocity,  tnd 

heading*. 

The  differential  equations  for  slroraft  acceleration  can  be  written  In  the  form 

i  -  »  +  X  + 1* .  o,  n 


where 

t  -  aircraft  looelerotion 
0  :  gravitational  force/unlt.  mass, 

A'  «  aorodynamio  force/unit  mass, 

Y  =  thrust  force/unlt  mass. 

Hie  velocity  r  and  position  z  would  comprise  sis  veotor  elements  each.  To  desorlbe  X  and  ?  ,  a  great 
many  more  state  variablos  would  be  needed.  Thie  definition  would  permit  treatment  of  tho  IMU  aoceleromoter  out¬ 
puts  and  many  other  sensed  quantities  (e.g. ,  engine  settings,  control  deflootiona,  oto. )  as  obaorvatlons,  If, 
however,  the  differential  equations  were  written  In  the  form 

a  w  1}  +  ?  ,  0,3) 

where  ?  represente  IMU  accelerometer  outputs,  than  it  would  no  longer  be  necessary  to  model  the  alroraft 
attitude  notloni,  engine  dynamloe,  ato,  A  large  nunbar  of  atate  variables  would  thereby  be  rtpleoed  by  tha 
outputs  of  a  meaaurlng  instrument.  In  tha  uas  of  Equation  (3,3),  however,  tha  IMU  aooslaromstar  outputs  era 
not  obaervationa  in  the  Kalman  filter  theory  sens*.  Instead,  they  are  forcing  functions,  Nevertheleaa,  as  will 
ba  aatn,  arrora  in  these  "Measured”  foroing  functions  can  be  accounted  for  with  this  approach. 

Ptar  either  of  the  two  eotw  of  Equation!  (3,1)  or  f3. 3) ,  Doppler  data,  barometric  pressure,  LORAN,  TACAN  and 
tha  like,  all  of  which  are  only  functions  of  position  'and/or  velocity,  can  be  treated  as  observations.  Suppose 
now  that  the  IMU  fills,  Aenumlng  that  Doppler  data  la  still  available,  the  equation 

S  =  «<t>  (3,3) 

can  now  bt  written,  where  g(t)  la  the  Doppler  velocity  meaauremente.  The  Doppler  data  la  no  longer  an  obaar- 
vation  In  the  filter  theory  aenae;  however,  the  LORAN  and  TACAN  data,  whioh  are  function*  of  the  position  state 
variables,  a  ,  are  still  observations, 

Tbs  definition  implied  by  Equation  (3.3)  was  the  on*  selected  for  C-B.  As  mentioned  earlier,  s  wander  azimuth, 
geodetic  vertical  frame  had  already  been  selected  for  the  navigation  equations.  Hence,  the  differential  Equations 
(3.3)  were  changed  to  define  the  vehlale  acceleration  and  velocity  in  thie  rotating  reference  frame. 

* 

Cere  in  ateta  veotor  definitions  elao  allowed  the  equations  for  the  deed-reokonlng  modes  to  be  aub-eete  of 
the  equations  for  tha  Copplur-lnsrtlil  modes,  Thie  permitted  a  much  almpler  overall  formulation  for  the  multi¬ 
mode  system. 


3.1.1  Frii-Intrtial  Woe  It  Nodtl 

As  already  discussed,  it  was  planned  to  ueo  the  free- inertial  navigator  (In  the  primary  icxiae)  for  updating 
the  total  eetimate  of  atate  In  tho  tine  intervale  between  moaeurement  cycling  of  the  Kalman  filter.  Therefore, 
the  need  for  an  intagratlon  of  nonlinear  differential  equations  as  part  of  tha  Kalman  filter  wee  obviated. 
However,  a  derivation  of  an  approximate  modal  of  tha  system  su  needed  a*  a  baala  tor  an  approximate  transition 
aatris  for  the  Kalman  filter.  Aa  described  earlier,  the  differential  equation*  for  the  ayetem  atate  were 


x  *  rix,t)  +  u . 

(3,4) 

Using  than,  the  variational  equations: 

X  X  A(t)X 

(3.B) 

nr*  r*qulr«d,  ehart 

A(t) 

»  Vj,((p(x,t))]|,(t).j(tl  . 

(3.6) 

j(t t)  la  the  satinet*  of  syetta  state.  Several  of  the  component!  of  X(t)  are  available  frna  the  inertial 
navigator. 


Hit  Inertial  navigator  cnnalsta  of  the  IMU  and  the  navigation  equation*  solved  In  the  NDC-10A1A  computer 
(see  Figure  1).  A  reasonable  aodel  for  Equation  (3.4)  can  be  defined  by  writing  approsiaat*  differential 
aquation*  for  the  IMU  computer  eystva.  To  illustrate  haw  this  oen  be  accomplished,  consider  the  modeling  of 
tb*  war  by  which  the  specific  fores  vector  la  obtained  for  input  to  tha  navigation  equation*  (sea  Figure  S). 

4  An  laertiel,  non-rotating  coordinate  frame  la  aiauavd  here  for  alaplicity  of  description. 


Ths  trim,  veotor  specific  forco  f,  In  transformed  to  tho  plsttnrm  rnfernnco  frame  by  the  transformation 
TpjilifM  ■  Slnoa  the  nooelaromotdr-aonnltlve  axer.  ary  not  precisely  orthoeonnl.  tho  non-orthoeonnl  trnnatornm- 
tlott.  Tji ,  transform*  tho  specific  force  to  accelerometer  axoa.  tn  addition,  ucceleromolera  have  scnle 
faotura  which  ara  not  precisely  known;  the  diagonal  matrix  KFA  represents  iheno  factors.  Finally,  the  ncceloro- 
motar  output*  are  alao  corrupted  toy  blue  olfHOta  and  noiau,  represented  by  tho  two  voctora  n^  and  a‘n 
raapootivaly.  The  vector  t0  represents  tho  simplified,  continuous  model  for  tho  outputs  of  the  actual 
aooelarometsrs, 

Standard  0-5  system  procedure*  include  prnvielon  for  estimation  of  all  tho  shove  neoelorometer-related  etrors. 
and  for  a  sst  of  tyro-related  srrora  dlsounaod  below  »e  *oll,  during  periodic,  laboratory  calibration  opcrgtlona 
on  atoh  IMU,  Theae  number*  art  than  lnoorpornted  into  the  computer  to  appropriately  compensate  ths  accelerometer 
inputs  to,  and  the  gyro  command  outputs  from,  the  computer  during  actual  ayutom  opBrntlon,  In  thla  connection, 
the  vector  *b  in  Figure  5  denotes  tho  calibration  for  accelerometer  null  bins  aV  ,  and  tho  h  *  3  matrix  [*j,j 
denote*  th*  calibration  for  the  accelerometer  acalo  factor  and  input  axis  orthogonnllty  errors,  that  la  J 

Kjl  *  . 


Tho  tatlmatsd  apeclflo  force  voctor 


oan  therefore  be  written  in  tirms  of  all  these  quantities.  The  trror 


In  Aa  dua  to  aaoh  on*  of  th*  contributing  aooeWrowatrie  trror  souros*  oan,  in  turn,  bs  approximatad  by  flrat- 
ordtr  variation*  of  thsa*  ralatlonahipa. 

The  trror  in  A(  caused  by  th*  trrors  in  th*  transformation  TfIJf(t)  must  also  b*  dtrlvtd.  Theta  lsttsr 
trror*  trt  oallud  tilt*  btosutr  idaslly,  Tpl|p  »  I  ,  if  ?,  it  dsflntd  in  ths  trut  lootl  tsngsnt  plant 
rtftrano*  systam, 

Continuing  with  Flgurt  5,  th*  vector  A,  fatdt  ths  navigation  aquations,  whinh  art  shorn  schtmatlotlly  in 
Figure  S.  Although  the  NDC-1051A  esloulstiona  art  dlacret*  rather  than  continuoua,  thoir  repetition  rat*  is 
high  (12  Hz),  Henoa  the  error  differential  aiiustions  for  thus*  cslculttlona  can  bo  approximated  by  taking 
gradients  of  the  nonlinear  equations  with  respeot  tu  the  various  variables. 

Three  of  the  nine  fundamental  state  varlshlss  can  be  Identified  by  referring  to  Flguro  B.  These  are  the 
Integrator  outputa: 

V|,  VL  •  vsrtlnal  and  ltval  vslooitlas 
h  *  altitude  . 

Two  othsra,  latitude  and  longitude,  are  obtained  from  the  tranaformatlon  T  .  Tho  final  fundamental  atato 


variables  ara  the  three  rotations  nooaasary  for  daflnlng  the  Mane  format  Ion 


p(t)  dlaousaed  above. 


Idle  oloaurs  of  the  loop  (l.a. ,  the  tyro  signal  processing)  it  llluatratad  in  Figure  7.  The  gyro  torqulng 
signals,  represented  by  the  veatar  ,  are  traneformed  hy  the  calibration  matrix  tg^).  TUI*  matrix  la  a 
calibration  for  the.  gyro  scale  factor  arrura  (diagonal  matrix  SFO)  and  the  gyro  input,  axis  non-orthngonalltiaa 
(matrix  Tgi,p).  Not*  that  Tgi,p  transform*  rates  from  ths  gyro  input  axis  frame  to  ths  platform  rsfersno* 
frame.  Alao, 

[g,j]  *»  (taro) <T01 2P)]‘ 1  . 

Shown  alao  art  tho  (u,J  matrix,  which  compensate*  for  gyro  drift  rates  oauaad  hy  static  mats  unbalance,  and 
tha  vaotor  ibc  ,  whlun  la  a  calibration  of  th*  fixed  gyru  drift  rate.  In  Figure  7,  is  the  actual  vector 
drift  rat*  of  the  gyros,  rsferrad  to  th*  input  axla.  Reference  5  glvaa  msny  details  on  th*  modeling  of  such 
faotors. 

Th*  final  output  is  the  total  inertial  rat*  of  tha  platform,  .  Again,  first-order  variation*  of  th* 
various  aquations  ara  uaad  to  datln*  errors  in  created  hy  th*  various  error  sourosa, 

Th*  proems*  just  outlined  ltd  to  the  definition  of  approximate  variational  equation!  for  tha  fraa-lnartlal 
navigator  errors  In  tha  atata-apico  form: 

(t  x  1)  («  x  9)  (9  «  41)  (41  x  1) 
a  *  a(t)a  +  /3(t>a{  . 
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Thar*  art  nlnt  error  atate  varlahlee  and  41  error  forcing  tunutiona.  Seas  of  the  trror  forcing  function* 
war*  assumed  to  bo  constant!  (t.g. .  accelerometer  and  gyro  mlgalignmeata).  while  other*  wart  prescribed  function! 
of  tha  flight  path  (e.g. ,  static  maaa  unbalance  drifts);  however,  known  fluctuation*  in  gyro  drift  rata  and 
acoalaromatar  nols*  naadad  a  random  characterization.  This  was  nooompUahad  hr  assuming  that  such  trrors  were 
representable  hy  whit*  noise  driving  *  flrat-ordor  filter  In  accordance  with  Figurn  S. 

Bifora  tha  final,  augmented  stmt*  vector  formulation  la  defined,  a  brief  oonaldwration  of  the  observation 
modeling  le  In  order. 
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3.  1.3  Obit r vat  ion  Motltli 

The  proem  of  appropriately  doaorlblns  tho  observations  and  tbolr  »rror  modal*  folio**  t  pattern  eimilar  to 
that  described  for  the  fr*e-ln*rtl*l  model. 

In  certain  instance*  (e.  g, ,  g  LORAN  time-difference  pair  and  lmrtlal  navigator  latitude  and  longitude),  .a 
nonlinear  equation  relator  tit*  Inertial  and  eubsyatom  measurenonts;  In  others,  a  direct  linear  relation  calats 
(a. |.,  barometric  preinure  altimeter  and  Inertial  altitude  Indication*).  In  either  oaio,  howovor,  linear  rela¬ 
tion*  (M  matrlcei)  between  Inertial  and  subsystem  error*  at  a  measurement  time  wore  developed  by  elmplo 
first-order  variation!, 

Modeling  of  the  time  propagation  of  subsystem  errors  noceaoitated  the  use  of  time-correlated  randum  variables. 
Them  were  all  approximated  by  white  noise  Into  a  first-order  filter,  ae  already  mentioned.  Thla  prooeee  led  to 
tho  definition  of  IT  more  error  etat*  variable!  (constant  blase*  and/or  correlated  nolao)  of  the  typo  described, 
by  the  ventor  V  of  Equation  (3,3). 

3.1.3  Final  l.inaar  Dynamic  Error  Mode! 

Augmentation  at  the  fundamental  state  vector  to  Inoludo  alt  the  deterministic  type  of  error  sources  led  to  a 
final  dynamic  error  model  of  the  form 

(87  k  1)  (87  *  87)  (87  *  1)  (87  x  1) 

i  -  (3.7) 

x(t>  =  Aft) x( t)  +  n(t)  . 

The  vector  3(t)  ropresont*  the  total  augmented  error  state  vector.  The  vaotor  n(t)  represent*  the  white 
noise  Input*  for  iota)  of  the  eugmanted  *t*t*  varlablt*.  Moit  of  th*  cooponents  of  n(t)  ar*  Identically  aero. 

It  ibould  b*  noted  that  this  model  eeeunis  n  snoeth  time  propagation  of  iy*t*m  error*.  In  reality,  bncenaa  of 
th*  quantleed,  Iterative  nature  of  digital  computer  eignal  pracaeelni,  the  actual  errora  really  exhibit  etelr- 
cae*  behavior.  However,  becnue*  of  th*  flnenoen  of  the  quantisation  (typically  one  part  In  a1’),  and  th*  high 
Iteration  end  campling  rate*  employed  (e.g. ,  12  Hz),  the  contlnuou*  approximation  is  en  adequate  one  and,  of 
dour**,  highly  convenient  for  simplifying  any  neceeeary  mathematical  manipulation*  of  tho  model. 

3. t  Ensemble  Error  Analyst*  Program 

At  thig  atgg*  of  tho  overall  development  effort  It  wee  poeeible  to  atert  the  oooetruotlon  of  a  87-verlnbl* 
ensemble  error .analyst*  program,  hereafter  called  Program  1  for  convenience  of  rcfercncu.  Th*  purposo  of  thle 
program  wee  to  estebllgh  the  eyetea  performance  possible  if  tho  C-8  Kalman  filter  incorporated  all  67  ateto 
variables,  Thle  error  model,  although  itlll  ipproxlmete,  contained  all  the  error  eourcee  considered  as  having 
gone  glgnlflcenoe;  It  Is  therefore  hereafter  referred  to  as  a  "complete'’  error  model. 

Data  tram  thla  pragma  wag  Intended  to  serve  aa  a  reference  standard,  against  whloh  the  performance  of  subse¬ 
quent,  lee*  sophisticated  alternative**  could  be  measured.  Construction  of  th*  overall  program  required: 

(1)  A  Mane  of  generating  dsalrel  flight  profiles. 

(2)  Input  means  for  controlling  *11  th*  assiaad  Initial  error  eourcee,  the  flight  profile,  and  the  eequeno* 
of  observations. 

<J)  Th*  algorlthai  for  th*  ohango  In  th*  error  coverieno*  matrix  resulting  from  ue*  of  the  observation*. 

(4)  The  algorithm  for  updating  th*  error  ooverltnc*  matrix  between  the  observations, 

Of  the**,  Item*  1  end  2  ere  program  detail*  which  will  not  be  pursued  her*.  For  Item  3,  an  optimal  filter 
wee  assumed..  Item  4,  however,  merits  soma  discussion,  since  it  Incorporated  some  approximation*  which  were 
subsequently  used  In  the  actual,  cn-board  Kalman  filter  program. 

3.3. 1  Pridittion  Bttmttn  Obiirvatlana 

The  algorithm  far  predlotlon  of  thg  covgrlinc*  ggtrlx  »crogg  th*  intervals  between  euoeeeslv*  operation*  wax 
developed  aa  follows. 

If  S(t)  denote*  the  error  In  the  atat*  satimate  at  time  t  ,  then 


L _ JLiJ 

•.Hew#®'1' ( 

«  •  *  K  ’  a  «  .  e  *  .  * 

•  ’»  4  »  "a  4  •  •  .  "  L 

'>v 

“^V-AaV.. " 


sy.-'  ' ■■v1 

.  '  .  •  S  '  A  ; 

*  -l  '  •  *  ■  '  a  •  •  *8  V  **  M  ^ 

X.'  S." 


< .•■>VV  V- v» \vv- 
VV-a,'a'a''a'a.- 

V  W  >  ■  I  4  e  ".eg  4 

h  *  a*  k  *■  .  'A  .eaJ 


l',- 

I  Vv."  .»  '.•"■<  *j  e 

‘.V.'-V  .Y.\V> ’>> 

V*  -  •  l  .  ** . . 


I(t,)  *  «(tw:t,)x(ts)  e  J**  ®(tB:T)n(T)  dr 


\ ■/  • .  - 
*  V  *\>\  "%  •  -y  *•  \mu' 


***•„ *  H‘*%  *\*'i  *~ea* 

«*■  -■  *  M  ’*  »  p  *  ''  Ig*  a 

V  A  A  . 

-‘-A  . A  A  .  A 

v.  A-A'A'' 


dxacrlboa  tbs  xrror  propagation  aoroxx  the  predlotlon  tie*  Interval  (At  3  t,  ■  t0)  between  eucceeeive  obeervetlon*'. 
Defining  tb*  oovarlano*  mttrlx  of  th*  error  by 

*  It  Is  epptreat  tbit  the  on-board  computer  could  not  eolvt  such  *  volialnoue  problem  In  real-ties  and,  a*  *111  be  eewo,  It 
la  eot  practical  to  do  so. 

4  Later  thlo  tlao  tntervel  illl  be  seen  to  b*  tb*  actual  oyollng  tlse  of  the  Kalman  filter. 
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It  follow  th»t 


P(tt>  =  B{»(ti)Sr(t1)>  . 


Pit.)  »  $(t-  +  At;  t,)P(t,)*T(t,  +  At;  t.)  +  R(t.+Ati  t.)  , 


(3.81 


where 


R(t0  +  At;  t0)  a  T)B{n(r)n1(f)H1(t+At;  d-nl’i 

*tn  *t0 


devieod,  As  »n  Illustration,  the  development  or  tlio  transition  matrix  proceeded  as  follows. 
The  transition  matrix  obeys  tho  differential  equations: 

♦<t)  =  A(tH>(t) 

♦<0)  a  I  . 

When  A  Is  a  constant  matrix,  a  closed- form  solution  for  $  can  be  obtained: 

♦(At)  a  G-Kfsl-Ai*1]  , 


slon  of  A  Is  laris,  howsvsr,  It  is  generally  'hopeleaely  intractable  to  algebraically  carry  out  ths  indicated 
matrix  Inversion,  Other,  epproxlmata  methods  must  therefore  be  used.  One  of  ths  simplest  of  these  Involves 
the  use  'of  the  power  series  expansion: 


♦(At) 


£(£)-** 


1  +  (AAt)  ♦  “  (AAt)  *  +  . . . 

at 


(3. 13) 


Tho  aeries  is  truncated  at  a  point  sufficient  to  provide  the  desired  accuracy, 
dependent,  which  Is  tho  oess  for  C-B  airborne  modes,  ths  corresponding  series  is: 

♦(At)  »  1  +  (AAt)  +  ^  (A  +  A‘)(At)'  +  ...  . 
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However,  If  A  Is  time- 


(3. 14) 


Ths  higher-order  terms  not  shown  uonteln  higher-order  derivatives  of  A  .  Thsrs  ere  eons  difficulties 
associated  with  attempting  to  use  a  truncated  form  of  thla  expansion,  These  stem  from  the  lepraotlcslity  of 
obtaining  ths  first-  end  higher-order  derivatives  of  A  ,  If  avoond-  or  hlghsr-ordsr  accuracy  is  required.  This 
lnpraotloallty  srlsss  because  A  naturally  contains  only  the  basic  Inertial  navigation  signals,  up  to  ths 
acceleration  level,  as  elements.  Use  of  terms  Involving  A  or  higher  derivatives  would  thsrsrore  require  ths 
artificial,  epproxlmata  generation  of  otherwise  unavailable  acceleration  derivatives, 

On  tha  othar  hand,  tha  acouraoy  Involvad  In  ths  uae  of  only  the  flret  two  terms  In  the  expanelon  depends  on 
ths  alls  of  At  .  It  was  avldent  aarly  In  ths  program  that,  becaust  of  tho  multiple  non-Kalman  funotlona 
required  of  the  C-B  computer,  only  a  small  parcsntagt  of  it*  raal-tima  uae  could  be  devoted  to  oycllng  the 
Kalman  computations.  In  addition,  aven  with  the  lirge  anticipated  reduction  in  the  else  of  the  state  vector 
(from  ST),  these  computations  would  still  be  lengthy  and  therefore  tine  consuming.  A11  of  this  suggested  that 
ths  design,  even  at  this  stags,  should  anticipate  thu  need  for  a  large  At  ,  i.e. ,  of  the  order  of  many  seconds 
to  a  fsw  minutes,  To  accomodate  this  need,  ths  fallowing  approach  was  adopted. 

One  of  ths  Important  properties  of  the  transition  matrix  la  its  exponential  character;  that  is,  tha  transiting 

t,  it  ths  product  of  the  transition  sstrloss  associated  with 


■atrlx  for  stats  tvolutlon  between  times  t,  slid 


stats  tvolutlon  from  t ,  to  t,  end  from  t,  to  t}  ,  respectively.  A  simple  extension  of  this  property  gives: 

♦<t.it,)  w  «(t,;t|I.1)»(t,.1;t|l.l)  ...  ♦(t,;tlVKtl;tl)>  .  (3,  IB) 


where 


*.  '  ‘a 


Denoting  t,  t,.,  *  At,  ,  and  lotting 


where  At  =  tB  -  t0  ,  the  At,  could  then  be  vleuallsttf 


aa  the  n  equal  time  Intervale  betwoon  n  ♦  1  aucceeslve  updates  of  all  navigation  ilgnala  by  either  ths  navi¬ 
gation  computer  (C-5  filter  mechanization)  or  the  navigation  sub-routine  (ensemble  error  analysis  program),  and 
At  could  be  vleuaUaed  as  tha  Kalman  cycls  time  ltaolf.  Sinoa  At,  could  now  be  aeeuned  quite  amsll  (down  to 
1/12  second  in  the  navigation  oonputer,  and  arbitrarily  small  in  tha  anacmble  program),  the  truncated  fora, 

♦(At,)  «  I  *  (A,.|At,)  «■  H*,. £1,1*  , 
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wes  tentatively  aitaumod  sufficiently  aoourate  (or  extrapolation  over  a  At,  interval.  Bubetl  tutiun  of  Equation 
(3,10)  into  (3, is)  given 


♦(At)  =  n[l  +  (Aj.jAtj)  H  JfA^At,)  Jj 


or,  for  n  >  1  (aee  footnote), 

mt) 


l  ♦  At*  i(AtV  jfc  A*.,  ♦  (At*)*  jfc  A,.,  g  Ak 


(3.17) 


(3, 18) 
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where  At*  *  Atj  *  At/n  ,  and  terms  of  order  higher  than  (At*)’  have  been  dropped. 

Equation  (3,18)  at.111  preaonted  difficulties  primarily  because  meohanl J.ation  of  the  last  (double  summation) 
term  suggested  considerable  complexity.  Thin  term  was  therefore  tentatively  dropped,  aa  were  all  the  remaining 
eooond-ordor  terms,  except  for  oertnin  principal  ones  ansoclatcd  with  oonetant  elements  of  the  matrix  Ajb1  , 


(3. IV) 


The  reaidual  expansion  finally  adopted  was  thus 

♦(At)  *  1  v  AgAt  +  iA*’At'  +  jfc  ^AKOi<  At*|] , 

where  A„  +  ANOj  ^  a  A,  t  ,  and  A0  end  Ak(^  ^  ere  respectively  the  conetant  end  non-oonetent  portlone  of 
the  eetrlx  A..,  .  Aj  represents  a  matrix  of  eeleoted,  principal  constant  elementa  of  a{>1  , 

For  prelleilnary  evaluation,  a  aaall  program  wee  constructed  to  check  the  validity  of  Equation  (3,1V)  if  uaed 
rsouraively  to  approximate  stationary  linear  dynamics  (e.  g, ,  the  C-S  ground  alignment  situation)  over  long 
periods  of  time.  Although  this  program  used  only  a  limited-dimension  model,  the  modal  incorporated  the  prlnoipal 
dynamical  oharaotarlatioe  aasoolatad  with  the  stationery  elements  of  the  A  matrix,  The  results  Indicated 
extramaly  email  puruuntage  drifts  relative  to  an  exact  solution  (obtained  by  use  of  Equation  (3. 12)  on  tho 
limited-dimension  model)  over  10-hour  periods,  even  with  At  aa  large  as  several  minutes. 

Tha  airborne  model  require  additional  non-etstionary  A  matrix  tarma  that  dopond  on  tha  aircraft  flight 
profit*,  Evaluation  of  tha  adequacy  of  Equation  (3.1V)  In  atrborn*  modas  was  therefor*  deferred  until  after 
tha  development  of  the  ayeten  simulation  program,  deiorlbed  later  in  this  ohaptsr, 

3,3.2  Observations 

Three  types  of  information  external  to  the  inertial  navigation  subsystem  would  be  available  for  companion 
with  Ite  output*  in  the  ground  alignment  mod*  and  the  inertial  and  Doppler- Inertial  navigation  aodea: 

(a)  baroeotrlo  altltuda  from  the  CADC; 

(b)  groundspstd  and  drift  angl*  from  tha  Doppler; 

(o)  tha  knowledge  that  tha  nos*  visor  la  eaasntiilly  stationary*  during  ground  allgnaant. 

Obgarvatlon  of  the  information  deiorlbed  by  (a)  1*  dlaouseed  her*  to  illustrate  the  general  approach. 

Bines  the  alroraft  it  parked  during  ground  alignment,  either  the  aero  vsloolty  or  the  fixed  position  of  the 
aircraft  can  be  used  aa  the  information  reference  against  which  to  compare,  respectively,  the  inertial  navigator 
valoolty  or  position*.  However,  since  the  use  of  vsloolty-level  neeiurementa  was  already  anticipated  for  Doppler- 
Inertial  navigation,  vsloolty  comparison  wax  aeleotad  for  ground  alignment.  'This  provided  a  greater  uniformity 
between  the  ground  alignment  and  Doppler-lnertlel  mode  mechanisations. 

If  either  one  of  the  inertial  navigator  level  velnalty  nedlngs  is  denoted  by  v  the  ourreipondlng  Kalman 
observation  Y  ,  uaad  in  ground  aliur.aant,  could  tharafora  be 
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Tha  signal  v  can  be  docoapoaad  into  tha  fora: 
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(3.20) 


ehar*  v ,  1*  the  aotual  visor  vsloolty  component,  dua  to  wind  and  loading  along  tha  level  direction  associated 
with  v  ,  amt  Sv  is  the  error  in  the  signal  v  arlelna  primarily  from  initial  tilts  of  tha  platform  with 
reepeot  to  tha  vertloal,  end  from  unouUbrated  platform  drift  rates. 
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From  the  standpoint  of  Equation  (3.20),  it  would  uproar  that  5v  la  the  siensl  containing  information,  ami 
v,  la  the  noise  from  which  it  must  bo  separated.  Howover,  this  assumption  about  vA  is  Juatlfind  only  if  vA 
consists  mostly  of  noise  which  is  of  high  frequency  with  respect  to  both  the  iiv  signal  content  and  the  con- 
tonplated  observation  iteration  rato.  Berauso  of  thn  frequency  response  characteristics  of  the  massive  C-5 
aircraft  to  random  wind  and  loading  disturbances,  this  proved  to  be  truo  for  ground  alignment.  If  it  wore  not 
trua,  It  might  hnve  boon  necessary  to  introduce  error  state  variables  to  account  for  systematic  low-frequency 
behavior  of  vA  to  meet  alignment  performance  goals.  Such  variables,  which  gonnralizo  thn  syBtom  error  atato 
vector  concept,  were  indeed  Introduced  elsewhere  to  account  for  low- frequency  components  In  other  mode 
observation!. 

Since  5v  was  an  early,  natural  cholcu  is  one  of  the  essential  ill-mode  state  variables,  and  alnoe  the  nota¬ 
tion  relating  measurements  to  state  In 


Y  -  Y  --  M(x-s)  +  q 


by  association,  M  was  therefore  defined  as: 


1  2  3  . . .  $v  . . .  n 


M  *  [0  0  0  ...  1  ...  u]  . 

The  choice  of  two  scalar  measurements  Instead  of  ono  (two-dimensional)  vector  measurement  for  ground  alignment 
dnerves  comment,  This  oholce  d.n  not  require  matrix  Inversion.  Instead,  two  successive  panes  art  mads  through 
tha  observation  update  portion  of  the  Kalman  equations,  Each  pasa  only  involves  a  division  for  the  inversion 
of  tha  quantity  (MPMT  +  C)  in  Equation  (2,9).  In  fact,  all  observations  were  defined  aa  acalara  to  make  this 
processing  simplification  uniform. 

Although  this  spprosoh  is  theoretically  exact  only  if  the  nolle,  aieooiated  with  each  asperate  observation  la 
uncorrelated  with  that  associated  with  every  other  observation,  ground  alignment  proved  to  be  the  only  C-5  caso 
where  thli  condition  was  net  substantially  met,  The  resulting  performance  of  ground  alignment,  as  will  be  seen, 
neverthelasa  nut  design  galls,  despite  this  thnoretlosl  Infringement. 

Having  daflned  the  observation  matrices  associated  with  all  C-5  modes  and  Information  souresa,  it  waa  than 
paiaible  to  complete  the  67-varlsble  ensemble  error  analysis  program  (Program  I)  by  Incorporate*  the  following 
matrix  equation*: 

Q  *  WklT  +  C 

b  =  WlV  (3.21) 

P  !=  P  -  »IP  , 

These,  together  with  Equation  (3.10),  completed  the  eet  of  reoursion  equationa  nectaaary  to  obtain  the  time 
history  of  the  covariance  matrix  P  of  navigator  errors  through  s  typlcsl  C-5  flight  opsratlon. 

To  simulate  such  flights,  the  program  waa  equipped  with  a  general,  flexible  flight  profile  sub-routine 
oapable  of  providing  great  clrole  orulse,  climb,  descent  and  turn  phases  In  any  commanded  sequence.  The  navi¬ 
gation  signals  thus  generated  were  used  to  drive  the  dynamic  elements  of  the  transition  matrix. 

Program  I  waa  coded  In  FORTRAN  IV  alngle  precision  for  use  on  the  IBM  7090  or  300  computers.  On  completion 

4ohechout,  the  Immediate,  extensive  use  of  Program  I  at  this  stage  established  the  ability  of  a  67-varlable. 

1  precision  7090  or  300  mechanization  to  meet  or  exceed  ail  C-5  navigation  system  performance  goals. 

3.3  Design  Review  and  Discussion 

At  thli  atage  of  the  development  Che  overall  final  filter  design  was  beginning  to  tike  shape.  Approximately 
half  the  development  ttise  had  elapsed,  however,  and  many  of  the  difficult  problems  Imposed  by  the  real-time 
computer  constraint*  had  yet  to  be  faced. 

3,3, i  Overall  Design 

The  overall  design  mechanization  for  the  multi-mode  system  waa  reasonably  well  defined.  Figure  9  is  a  func-. 
tloual  block  diagram  of  ths  overall  mechanization,  showing  the  role  of  the  filter  In  ths  overall  navigation 
Information  processing.  Although  this  Is  essentially  an  analog  diagram,  definition  of  the  overall  sequencing 
of  the  digital  calculations  was  alio  well  edvanced,  as  will  be  ssen  below. 

In  this  connection.  It  wts  recognized  that  the  actual  Kalman  filter  would  require  an  appreciable  time  to 
proceeg  a  single  act  of  observations  and  to  produce  revised  error  estimate <  for  epplication  as  system  corrections. 
While  thle  wan  going  on,  data  on  current  position  and  velocity  would  continue  to  be  required  for  Inputs  to  other, 
non-navigatlonal  functions  (■*.  g. ,  el rcruft  steering)  and  for  display.  Since  such  signals  might  be  available  at 
■everal  different  points  (e. g. ,  ircundspeed  from  corrected  Doppler  groundspeed  or  from  the  horizontal  navigation 
equations  in  Figure  9),  one  source  had  to  be  uniformly  selected  as  "best"  between  successive  Kalman  corrections, 
Because  of  their  relatively  high  update  frequency  and  their  relative  smoothness,  the  (corrected)  inertial  naviga¬ 
tion  signals  wore  chosen  as  the  best  outputs  for  this  purpose. 
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3.3.  !  Kalman  Filter  fieiign 

Table  I  aummarlzea  the  C-S  Kalmon  filter  equatluns.  The  compu'  uona  shown,  together  with  the  formntlon  at 
the  various  matrices  Involved,  comprise  one  full  Kslmsn  processing  cycle  in  the  on-board  computer,  and  are  given 
In  the  order  of  actual  processing. 

As  discussed  earlier  In  this  chapter,  the  Kalman  equations  are  modified  to  Include  tho  "epsilon"  wclahtlng 
technique  and  to  provide  for  system  and  estimator  control.  At  one  time  It  was  contemplated  not  to  mechanize 
control  st  all,  but  rather  to  perform  only  opon-loop  error  estimation.  Navigation  signals  would  then  bo  oorrsoted 
with  these  estimates  only  for  output  to  other  equipments.  This  approach  was  discarded  In  favor  of  the  closed- 
loop  control  technique  shown,  because  it  wua  recognized  that  otharwlso  the  linearization  required  would  be  done 
about  the  uncontrolled  system  state.  A  large  error  build-up  In  this  uncontrolled  state  would  cause  a  corres¬ 
pondingly  larger  departure  from  the  desired  linear  properties. 

The  essentials  of  tho  control  technique  used,  which  are  summarized  symbolically  In  Table  I  by  tho  notations 
t()  and  g()  ,  are  as  follows: 

(a)  Im/iuliivo  Control  Whorever  possible,  tho  contents  at  a  computer  register  whose  error  is  modeled  as  a 
stats  vector  element  sre  corrected  by  adding  the  estimate  of  error  (with  the  proper  sign)  to  tho  computer 
register,  Simultaneously,  the  register  containing  the  error  estimate  Is  eet  to  zero.  Thle  Is  done  to  each  sueh 
register  pair  one  in  every  Kalman  computational  oyde. 

(b)  Finitt  Duration  Control  The  above  Impulsive  type  of  control  is  used  uniformly  lor  all  registers  controlled 
by  the  C-5  Kalman  mechanization,  with  one  Important  exoaptlon,  This  ezoaptlon  portains  to  those  two  state  veotor 
•laments  which  model  ths  two  cosiponenta  of  platform  tilt;  l.e, ,  the  two  components  of  the  email  angular  deviation 
between  the  gotutl  end  desired  platform  vortloala.  To  rtmovs  tho  aotual  tilts,  the  gyros  are  commanded  to  torqua 
the  platform  vertical  at  a  uni  form  rate  over  the  next  Kalman  Interval,  This  rate  is  exaotly  that  required  to 
take  out  the  eatlmated  tilt  in  the  platform  In  one  Kalman  cycle.  At  the  time  time  that  thesa  leveling  ratee 

ere  firet  applied,  the  platform  drift  rate  estimate*  are  let  to  thees  computed  leveling  rates.  The  current 
tilt  satlmates  are  left  untouohed. 

Note  that  a  baelo,  built-in  Invariant  lmplloit  In  these  control  teohnlquee  la  tha  difference  between  the  actual 
and  the  estlaated  eyatem  behavior.  Thla  Invariance  allow*  retention  of  the  elmple,  open-loop  covariance  matrix 
reouralon  relation*  unchanged,  If  It  i»  aasumed  that  tho  additional  error*  created  by  the  application  of  oontrol 
art  negligible,  thla  aasumption  was  made  at  thla  atage  of  development  for  later  validation. 

The  off-optimal  "epallon"  faetor  was  introduced  in  the  design  algorithm*  as  a  precautionary  measure  to  oombat 
uwodtled  and  numerical  error*  (as*  Reference*  7  end  8). 

3.3.3  Othir  Haltvant  Information 

Concurrently  with  the  effort 'described  thus  far,  some  additional  data  wa«  being  accumulated  as  a  result  of 
related  work  on  another  eyatsa.  For  eismple,  an  NDC-1051  eoaputer  (24-bit  word)  had  been  programed  for  Kalman 
eetlaatlon  in  ths  fin*  ground  align  mods,  and  laboratory  testa  were  conducted  with  an  INI)  of  different  design 
from  another  progrm.  The  results  were  not  overly  encouraging. 

On*  of  the  problems  was  the  difficulty  of  maintaining  a  pceltlv#  daflnits  ooverianee  matrix.  The  other  eppesr- 
*d  to  be  oonneoted  with  the  ua#  of  fixed-point  arithmetic.  <  nly  poor  aatlmataa  of  gyro  drift  rates  wars  obtained. 
This  sesaed  to  be  tied  to  the  lose  of  numerlosl  significance  In  the  covarienoe  matrix  due  to  the  fixed-point 
calculations.  Thoea  results  were  on*  of  tha  reasons  for  the  introduction  of  tha  "epallon"  technique  In  the 
basic  Mechanisation  aquations  for  tha  C-9  aystsa. 

3.4  Censtralnt-Iapaseil  Problems  and  Solution! 

On*' of  the  principal  problem*  which  had  to  be  dealt  with  at  this  point  wo*  the  identification  of  the  smallest 
system  error  model  which  oould  be  mechanized  for  the  on-board  Kalman  filter,  and  still  aset  system  performance 
goals.  Uaa  of  the  complete,  67-vtrlsble  model  of  Program  I,  for  example,  would  require  far  too  muoh  memory  and 
real-time  of  the  on-board  computer.  Hoetver.  Program  I  results  did  Indlosta  that  th*  onmplet*  model,  If 
mtohanlzed,  would  substantially  surpass  system  psrforasnow  goal*.  Thli,  therefore,  provided  a  reoaonable  per- 
foraano*  aargin  to  work  with,  in  term#  of  the  lata  of  performance  Inevitably  expected  from  on-board  us*  of 
■taller  aodels. 

Actual  quantitative  evaluation  of  thle  performance  lots  li  a  relatively  subtle  problem  which  cannot  be  solved, 
for  example,  by  eoaparleon  of  67-v»rl*bl*  model  Program  1  results  with  reaulta  from  an  analogous  program  in¬ 
corporating  th#  smaller  modal.  Rather,  a  more  ganeral  typa  of  computer  error  analysis  program  la  required. 

As  will  ba  assn,  tha  stringent  ovarmll  C-S  development  schedule  had  a  direct  affect  at  this  time  on  the  selection 
of  th*  type  of  program  to  ba  oonatructed  to  fill  this  role. 

In  addition,  definition  of  th*  airborne  computer  tope  sub-routines  had  bean  proceeding  concurrently  In  *11 
Other  non-Kalaan  tress.  31noe  design  in  these  more. conventional  areas  naturally  proceeded  faster  than  it  did 
la  th*  aor*  novel  Kalmen  ares,  the  procrams  for  these  aub-routlnaa,  together  with  their  attendant  word  oount 
and  time  allocations,  began  to  crystallize  somewhat  ahead  of  those  for  the  Kalman  aub-routlne.  This  process 
led  to  the  sarly  establishment  of  word  oount  and1  real-time  allocations  for  the  Kalman  aub-routlne,  These  allo¬ 
cation*  constituted  the  two  primary  constraints  on  the  filter  design. 
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TO***  contralnts,  together  with  the  accuracy  goal*  amt  til-node  operation  requirement*,  comprised  the 
framework  erlthln  which  the  Kalman  deelcn  hed  to  be  completed.  The  problem*  created  hy  these  contrelnts,  the 
method*  o(  tttack  uteJ.  end  the  (Inti  design  solutions  tdopted  tie  now  discussed, 

3,4,1  Computer  Stonge  Coniidtrat  ionf 

The  relttlve  frtotione  of  the  tottl  computer  stortto  tlloctted  to  the  various  (unotlons  of  t  reel  system 
like  this  one  la  alwtye  t  nstter  of  compromise,  requiring  continuous  trede-off  evaluations.  A  Kalman  filter 
having  (ufflclsnt.  dlmention  to  satisfy  the  C-6  requirement  wes  new,  although  experience  did  exlet  on  more 
limited  implementation*.  Howavor,  these  lmplementstions  were  Inadequate  an  a  basis  for  estimating  the  C-5 
Kalman  itorsgo  requirement.  Nevortheleee,  the  atorege  available  was  defined  quite  .oloeoly,  heesuno  the  12,288-word 
total  (prlmmy  computer)  was  fixed  and  the  requirement  for  moat  of  tho  other  routines  could  bo  closely  estimated 
on  the  btele  of  experience. 

Depending  on  ho*  much  program  compaction  effort  wes  to  be  applied  to  the  other  routlnos,  the  storage  available 
for  the  Kalman  routino  ranged  from  2000  to  3000  words.  It  was  immediately  evident  that  tho  model  size  must  be 
reduced  (from  67)  as  far  as  performance  goals  would  allow. 

In  conjunction  with  this  effort,  It  beciwe  evident  that  the  minimal  word  length  to  be  used  In  oarrylng  out 
*11  arithmetic  operations  would  have  to  be  determined.  If  double,  rathnr  than  single,  precision  operations 
were  used,  these  would  obviously  double  the  non-lnstructlon  storage  requirement!.  This  consideration  of  word 
lengtli  also  naturally  raised  e  question  u  to  tho  type  of  arithmetic)  to  bo  used  (fixed-  or  floating-point;. 

Finally,  further  consideration  strongly  suggested  that  the  requirement  for  multi-mode  filter  operation  might 
demand  e  sizeable  portion  of  the  overall  Kalman  word  allocation  for  intermode  switching, 

3,4,3  Error  Model  Dimtntion 

It  mi  recognized  immediately  that  a  natural,  two-atap  ltaratlva  process,  together  with  the  techniques 
neoeesary  to  carry  out  these  steps,  would  be  required  to  determine  the  minimal  error  mudol  for  the  Kalman  filter 
mechanization.  These  etepa  were  (1)  a  method  for  systematically  discarding  error  variables  from  the  complete 
(67-varieble)  model,  end  (2)  e  method  for  evaluation  of  the  reduced  models  thue  obtained. 
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This  lattar  need  -  for  a  reduced  modal  evaluation  tool  -  led  to  the  development  of  the  seoond  major  ensemble 
error  analysis  proarem  (hereafter  referred  to  as  Program  II),  Two  types  oi  formulation,  of  differing  capabili¬ 
ties,  were  considered.  The  first  and  mora  genaral  of  the**  eaa  based  on  an  axtendad  eat  of  rouurulvt  oovarlance 
matrix  equations  (see  Reference  8).  This  type  of  formulation  allows  complete  freedom  In  discarding  (a)  arbi¬ 
trarily  selected  error  variables,  end  (b)  arbitrarily  selected  elements  of  the  residual  transition  and  system 
noise  mmtrlaes. 

A  seoond  and  simpler  formulation  was  also  available10.  This  one  allowed  calculation  of  th*  lnorsass  in  srror 
produced  by  discarding  cant  tun  t  state  vector  elemeeti  only.  Despite  this  theoretical  limitation,  it  bed  the 
overriding  advantage  that  it  allowed  rigorous  handling  of  til  bias  error*  (wltluh  were  predominant)  and  permitted 
much  faster  program  oonstruotlcn  by  only  requiring  the  addition  of  a  few  sispl*  operations  to  Program  V  For 
practical  reamona,  than,  end  In  the  light  of  the  tight  development  schedule  requirements,  the  second  and  simpler 
formulation  was  adopted. 

An  efficient  method  for  dlaoardlns  variable*  had  to  b*  deviled,  since  th*  turn-around  time  for  Program  II 
results  was  on*  or  two  days.  Hence,  the  obvious  brute- force  approach  involving  removal  of  one  variable  at  e 
time  could  not  be  used.  Instead  It  wes  necessary  to  try  to  Identify  it  once  eon*  extensive  eats  of  variables 
whose  removal  would,  in  a  few  steps,  closely  approximate  th*  desired  slnlmal  error  model.  These  discarded  seta, 
which  finally  comprised  no  lea*  then  91  of  th*  original  87  variables,  were  arrived  at  as  follows. 

Between  the  time  that  Program  I  (the  original  67-verlebl*  model)  wes  formulated  and  Program  II  was  completed 
end  available,  It  hed  been  determined  for  a  variety  of  practical  reaaone,  not  to  provide  outputs  from  certain 
co-board  navigation  equipments  as  Kalman  filter  inputs,  Th*  etetl  variables  originally  included  In  th*  87-veriabl* 
model  to  account  far  the  errore  In  these  measurements  wera  thus  automatically  discarded  as  a  first  stop.  For 
exemple,  although  two  radar  altimeters  would  be  aboard  th*  C-5  sirorsft,  thess  would  only  furnish  altitude  above 
terrain,  and  up  to  a  maxima  of  only  2500  feet.  Since  only  th*  eetlmetlon  of  altitude  above  sea  level  was  con¬ 
templated  for  the  Kalman  filter,  and  since  th*  C-5  aircraft  would  typically  spend  only  s  negligible  percentage 
of  mission  time  below  2500  fast  over  tho  ocean,  use  of  th*  radar  altlsetar  date  by  th*  filter  we*  excluded. 

Th*  radar  altimeter  stmtw  variables  in  the  original  error  model  could  therefore  be  discarded, 

In  addition,  where  several  element*  had  been  used  In  tb*  complete  sodel  to  describe  th*  high,  intermediate, 
and  low-frequency  components  of  the  error  in  s  subsystem  navigation  rtferanot  aignal  (*.*.,  Doppler  groundspeed), 
them*  were  compreeeed  Into  one,  where  plausible,  by  eliminating  all  but  tha  largest  amplitude  component. 

Finally,  tha  largeat  of  the  trial  aeta  of  discarded  elements  wu  composed  of  the  velooity  end/or  eoceleretlon* 
sensitive  errors  associated  with  th*  IHU  gyros  and  aocalerometsra.  These  errore,  elthough  Important  in  e  tactical 
aircraft  deilin  application,  were  expected  to  produce  only  alnor  performance  degradations  in  such’ s  huge  trans¬ 
port  aircraft  as  th*  C-5. 


‘'v;  a 

!*  V  \*  \/*  "s'  V*  V* 

jVX'Ny-VI'-iV: 

,  *  *  -*  t  *  „  •  ,  »•  ».  *  .T*-  , 


■y-v-v-- ’v : 

•V*”.  "\. 

r  *■..«*»  w  «.  .  .ii 

*  "  *,N  '  *.  *  “<e»  v  • 

V\>’ *’  , 

*  '  i*  **  •*  ^  '#  * 

•/ 

V>  v-  v  vv  \ 

*  4k  \  ’*  ••  ‘a  V 


.  *  •  Te*  «  * 


'.IV. 


-V 


.sv- . 


*v  .s  . 


V-JaM 


300 


Tablee  II  and  III  euxmarlze  the  87-to-lfl  ciodol  ilze  reduction  finally  attained  by  the  technique*  Just 
dteorlbed.  Figure  10  Illustrate!  the  email  ensemble  performance  degradation  of  the  final  16-variable  model, 
relative  to  the  complete  model,  for  a  typical  C-S  great  circle,  flight,  ee  obtained  by  Program  II. 
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3.i.3  ford  Lintth/Arithmtic  Type 

In  parallel  with  the  effort  to  reduce  error  model  alee,  an  Investigation  was  eonduotcd  to  determine  the  moat 
suitable  word  length/arlthmotlo  type  for  the  filter, 

One  of  the  problems  identified  limit  at  the  start  of  this  effort  was  the  large  dynamic  range  requirements 
of  oertaln  covariance  matrix  elegante  during  the  transient  phaaea  of  filter  operation.  For  example,  It  wag 
estimated  that  platform  tilts  of,  typically,  one  degree  would  have  to  be  reduor  to  about  one  second  of  aro  In 
a  short  period  at  the  beginning  of  ground  alignment,  This  reduction  was  necessary  to  achieve  sufficiently 
accurate  platform  drift  rate  calibration  during  the  remaining  ground  alignment  time.  The  ratio  of  starting 
tilts  to  residual  tilts  Is  about  3600  to  1.  The  tilt  variances  carried  in  ths  covarlanoi  matrix  must,  however, 
traverse  ths  square  of  this  range  (l.e, ,  about  10’  to  1).  A  single  word  of  ths  airborne  computer  Is  only  28  bits 
(21  bits  plus  sign)  In  length,  Hence,  If  single  precision,  fixed-point  arithmetic  were  used,  the  accuracy  of 
settled  tilt  variance  computations  would  only  Be  about  3  binary  bits.  The  effsot  of  round-off  and  truncation 
arrora  on  a  word  of  only  3- bit  significance  during  thig  critical  alignment  parlod  was  believed  to  be  Intolerable. 

At  thle  Juncture,  a  wide  variety  of  alternative  iclutloni  leaned  available,  comprising  all  ramalnlng  concalvabla 
combinations  of  (1)  word  langth,  and  (11)  flsad-  or  floating-point  arithmetic,  However,  In  ths  light  of  further 
tcrutlny,  than  option!  wiri  not  gll  practical  pottlbllltlag. 

Before  the  final  reduction  to  16  variable!,  s  m—M  of  dimension  24  had  been  attained  In  ths  parallel  error 
modal  alia  reduction  Investigation.  With  this  site  as  -  oasis,  s  preliminary  siting  of  tha  ovarall  Kalman  sub¬ 
routine  storage  requirements  had  produced  an  sstlmsts  of  2300  words,  predicated  cn  ths  use  of  double  preolaion, 
fixed-point  arithmetic. 

Although  this  figure  wna  still  In  ths  bell  perk,  It  was  evident  at  this  point  that  3300  words  could  be  mads 
available  only  If  s  considerable  programming  effort  on  the  other  routine*  wes  undertaken.  (Because  of  experience 
gained  on  previous  prosrtms,  most  of  ths  other  routines  already  made  efficient  use  of  storage  and  further  oom- 
protion  would  have  bpun  difficult.)  Therefore,  the  neaesslty  for  implementing  ths  double  precision  fixed-point 
arithmetic  approach  (or  in/  method  that  required  more  than  a  aingla  28-bit  word)  was  questioned.  Attention  waa 
than  focused  on  the  use  of  tloatlns-polnt  arithmetic.  Plaid-point  arithmetic  require!  careful  soiling  of  all 
vmriaBlea  so  that  adiquatw  ilgnifloer.es  la  retained,  whll*  avoiding  any  danger  of  overflow.  Th*  icallng  oon- 
ilderatlon  la  unusually  complicated  in  the  Kalinin  filter  routine  bsoeuse  of  the  extensive  matrix  operations. 

A  elgnlflcant  advantage  of  the  floating-point  approach,  therefore,  le  that  ths  veiling  task  la  avoidod  entirely. 

IBs  hardware  peculiarities  of  the  machine  Itself  new  comnletmd  the  rapidly  narrowing  restriction  of  oholoe. 

Th*  NDC-1051A  oomputer  had  a  built-in  (l.e.,  hardwired)  oepabllity  for  performing  either  full-word  ur  half-word 
flied-putnt  arithmetic.  It  was  not  practical  to  contemplate  a  split  of  the  full  28-blt  word  Into  a  mantissa 
oueprlslng  moat  of  these  28  bite  and  t  avail  exponent  to  provide  Just  enough  dynsnio  range  to  satisfy  covtrlanos 
matrix  requirement!.  (Although  auch  a  iplit  could  be  used  If  accompanied  by  attandant  aub-routlne*  to  provide 
erlthmetlo  operations,  such  sub-routines  were  expected  to  be  somewhat  slow.  Thle  would  have  resulted  In  an 
inofflolent  use  of  computer  time. ) 

The  design  oholoe  was  thus  narrowed  to  tho  use  of  floating-point  erlthmetlo,  utilizing  e  single  28-blt  word 
shared  equally  hr  mantissa  and  exponent.  In  particular,  the  restriction  to  a  short  14-blt  (13  bite  plus  sign) 
mantissa  created  a  need  for  evaluation  of  filter  performance  with  respect  tc  round-off  end  truncation  arrora. 

Blnoa  this  evaluation  waa  clearly  bayond  th*  existing  or  sully  augmented  oepebllitlnn  of  either  Program  I  nr 
Program  II,  a  requirement  for  a  new  type  of  evaluation  program  waa  established. 

Finally,  it  Is  pointed  out  bert,  for  reference  latar  In  this  chapter,  tbit  th*  adoption  of  floating-point 
xrlthmatlc  wag  th*  first  and  eajor  contribution  toward  Increasing  the  single  Kslmen  cycle  execution  time.  Boa* 
preliminary  estimates,  mads  at  about  th*  time  this  technique  waa  adopted,  Indicated  uninterrupted  execution  times 
of  about  10  etconde.  The  preliminary  real-time  budget  nllonated  about  20%  uf  computer  real-time  during  ground 
alignment  and  6%  In  flight  to  th*  Kalinin  routlnn.  Inin  lad  to  satlmates  uf  one  to  three  minutes  for  on-board 
axaoutlon.  As  will  1 y  naan,  th*  unavoidable  aadrgtnct  of  these  slow  Kalman  oyclsa  led  to  a  challenging  problem 
Uttr  in  tha  development, 

J.4. 4  dulti-itodt  Requirement! 

The  prooedlng  paragraphs  have  cratered  on  tbe  effort  to  optimise  denlgn  of  tho  Knlmnn  filter  nlgorlthms  with 
respect  to  storage  requirements.  These  efforts  were  characterized  by  us*  of  th*  error  model  ueocinted  with 
th*  most  complicated  mode  of  C-3  navigation  system  operation.  Thin  is  th*  Dopplcr-Baromatrie-Inertisl  mode, 
augmented  with  position  fixe*  from  any  or  all  of  the  on-board  poaitlon-aeMurlng  eub-eyatem  equipments. 

However,  aa  has  been  pointed  out,  meny  different  mode*  of  eyetea  operation  were  contractually  required.  The 
error  aodel  usoolated  with  each  such  mod#  differed  with  evwry  other  to  varying  degrees.  Hence  th*  problem*  of 
bov  to  eechulz*  all  auch  aodea,  and  how  to  rwl  tch  between  them,  bed  to  be  addreused. 


k ' 


■  •  V  V  V  v  / 
rV,\v>V-.V>  , 


'  -w  *“*  . 


.V' 

■\v 


•  xa\  »>. 


Multi  -unrip  operation  Implied  nniin  switching  In  somewhat  arbitrary  aoqimnnuit,  and  optimal  operation  require* 
continuation  or  relatively  complex  transfer  of  the  estimation  pnicenv.  For  thoau  ruuson*  a  unified,  multi-mode 
Kalman  filter  doalgn  was  formulate, i  in  solving  tiiu  problem  of  minimizing  storage  rtquiremont*  with  thi# 

nelocted  approach,  the  concept  of  me  etandard  error  mudel  proved  particularly  uneful,  an  follow*. 

This  standard  model  was  composed  of  the  separate  error  models  for  the  Inertial  navigator,  the  Doppler  (ground- 
apesd  and  drift  dngle)  Inputs,  ami  the  CADO  (barometrio  altitude)  input.  As  much,  It  constituted  the  largest 
dimension  (10)  model  required  for  dynamic  error  propagation  In  any  navigation  and  alignment  mnde.  Further,  the 
gtat*  vuctar,  transition  matrix,  and  system  nolxo  matrix  required  to  characterize  any  other  mode  could  in  every 
osaa  bo  described  either  in  terms  of  aub-sete  of  tho  atundard  slate  voctor  and  troneitlon  and  system  nolae 
oiatrlcea,  or  as  slightly  modified  sub-sots  whoso  dimensions  never  oxooedori  IB,  To  a  large  extent,  these  con¬ 
venient  error  model  sub-sets  existed  booauae  of  tho  cere  which  had  bran  previously  taken,  with  regard  to  lnter-modo 
uniformity,  In  tho  design  of  the  signal  flow  In  each  of  the  mode  mechanizations, 

lha  ust  of  this  concept  made  It  possible  to  view  all  non-*tandard  modes  as  involving  elgnlflcant  Information 
In  only  Contain  well-doflned  portions  of  the  estimate  and  control  vootorn  and  of  the  covariance  and  system  nolnc 
matrices,  during  both  time  end  ii.cnaurement  update  opurutlona,  Tho  overall  filter  operations  oould  then  always 
ba  done  on  s  fixed  dlmonslon  (IB)  basis,  independent  of  made,  without  corruption  of  th*  Information-carrying 
portion  of  these  matrices  by  tho  portions  carrying  meaningless  information.  The  continuity  of  state  variables 
conn  on  to  all  modes  (e. g. ,  position  orrora)  also  facilitated  tho  design  of  intor-mode  switching  and  initialization. 
Rigid  conformity  to  thene  principles,  in  conjunction  with  Incorporation  of  the  IB-variable  model  and  alngle-word 
floating-point  arithmetic,  ultimately  led  to  an  all-mode  doalgn  which  latisfled  the  3300-word  allocation. 

3.  4.5  Computer  flial-Tixi  Allocation 

Throughout  the  early  and  Intermediate  design  definition  phatei,  there  was  a  gradual  but  nearly  Inevitable 
drift  toward  a  design  requiring  moro  and  mora  execution  time.  This  drift  wan  reoognlced,  and  investigation  of 
Its  implications  on  the  final  dealgn  ns  therefore  Initiated. 

The  flret  problem  woe  the  need  for  development  of  a  troneitlon  matrix  capable  of  extrapolation  toroea  rela¬ 
tively  largo  time  intervals,  The  second  problem  was  the  potential  losx  of  refortnoa  Information  (e,g, ,  Doppler 
groundapeed  and  drift  angle  measurements  in  Doppler-Inertial  operation),  Tills  latter  problem,  which  would  erlee 
In  the  less  frequent  eimpling  imposed  by  e  elower  filter  cycle,  was  initially  lgnorod  because  It  was  assumed 
that  almple  measurement  averaging  over  the  alow  Kalman  samputatlenal  oyolt  woe  a  solution.  Thla  assumption  led 
to  the  eppearanoe  of  an  unanticipated  problem  lata  in  tha  development. 

3.4  6‘  Tronr  it  ion  Matrix 

The  early  efrort  In  tills  area  has  already  been  discussed  In  some  depth.  Th*  need  for  evaluation  at  th*  pre¬ 
liminary  formulation  developed  at  that  time  had  alrbady  created  th*  flret  need  for  a  new  tool  with  capabilities 
beyond  thoe*  at  ensemble  Programs  I  and  11.  The  aystem  aimulation  program  (SBP)  developed  to  fill  thla  end  many 
other  role*  In  the  overall  Kalmsn  filter  development  is  described  later  In  thi*  chapter. 

3.4.7  Measurement  Averaging 

on*  of  the  more  etringent  design  goals  of  the  C-B  navigation  system  design  wot  th*  abort  time  allowed  for 
th*  alignment  and  calibration  of  the  Inertial  platform  prior  to  Inertial  or  augninted  inertial  navigation.  Thi* 
led  tu  th*  attendant  opeelfloatlon  of  th*  Kalman  filter  as  th*  only  epprooch  believed  capable  of  achieving  the 
desired  calibration  levels  In  such  short  timet.  However,  is  with  all  statistical  filter  methods,  success  of 
th*  Kalman  filter  depends  on  the  emount  of  measurement  data  available  In  s  epeolfied  time  interval. 

As  an  axanple,  tha  velocity  signal  to  be  used  as  the  bwaio  ground  alignment  meoeurement  would  be  corrupted 
tqr  the  velocity  errors  produced  by  the  effects  of  wind  and  cireo  loading  on  the  parked  aircraft  during  tho  align¬ 
ment  period.  Th*  time  required  to  complete  a  single  Kalman  computational  oyole  was  expected  to  be  about  one 
■lnut*.  However,  If  the  etandard  Kalman  formulation,  which  can  accept  only  a  atnglo  measurement  in  each  cycle, 
were  used,  only  about  on*  noisy  deta  sample  could  be  processed  etch  minute.  On  the  other  hand,  It  had  already 
been  determined,  almost  at  program  inception,  that  data  ssmpllng  rates  of  at  least  one  simple  per  second  were 
required  for  adequate  noise  smoothing*. 

To  thla  end,  It  was  proposed  simply  to  pre-average  the  (once  per  second)  velocity  readings  over  the  Kalman 
interval  and  us*  th*  reeult  for  the  measurement  once  per  minute,  Thla  seemed  such  on  obviously  satisfactory 
solution  that  it  van  accepted  on  the  ipot.  end  attention  see  directed  to  other  areas.  Much  later  in  th*  program 
this  decision  wse  re-examined.  A  smell  ensemble  error  analysis  program  waa  constructed  to  quantitatively  evaluate 
th*  performance  of  this  averaging  process  with  respect  to  platform  drift  rate  recovery,  Th*  result*  were  un¬ 
satisfactory:  rather  than  converging,  th*  solution  diverged  -  to  e  point  far  beyond  that  required  to  meet  minimal 
system  navigation  performance  goals, 

Analysis  of  thla  phenomenon  led  to  a  simple  conclusion.  Not  only  was  the  signal  noise  being  smoothed  (as 
desired)  by  the  averaging  process,  hut  go  waa  the  signal  Itself!  This  created  serious  driving  error  (e. g. ,  plat¬ 
form  drift  rate)  identification  problems  for  the  standard  an  formulation,  which  is  based  on  use  of  signal 
soap  lea  rather  than  signal  averages. 

*  Thil  Information  had  been  obtained  from  a  snail,  epee  la  1 -purpose  allgnmant  evaluation  program,  incorporating  a  aimpllflad, 
alnile-txU  leve lint  loop  modal. 
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A  modification  of  the  Knlman  measurement  prucesolng  formulation,  designed  to  accommodate  averages  rather  tlmn 
(ample*,  was  thoreforn  evidently  necessary,  Thin  wan  undnrtaken,  and  led  tn  a  simple  modification  of  the  stnn- 
dard  formulation,  Finally,  a  a  Imp 1«  ensemble  error  analysis  program  wan  constructed  to  tvaluntn  tho  effect  of 
thla  method,  Figure  11*  shown  i  sample  of  the  successful  rosults  of  compensated  averaging,  as  well  aa  tho 
divergent  characteristics  obtained  with  uncompensated  averaging. 


The  modification  developed  la  based  on  the  assumption  that  one  may  rofer  measuromnnta  to  a  fixed  epoch  (time 
point)  of  the  state  vector*: 

y(t)  -  M(t)4(t;ts)x(t0>  +  q(t)  .  (3.23) 

If  n  measurements  y^tp  1"  the  Interval  t„  -  ta  t  At  are  avor  ged,  It  follows  that 

■jSyj'tj)  =  £  [^Htftjl^ftj:  t0)]*ft0)  t  ~  rqttj)  .  (3.231 


Since  q(tj)  la  assumed  to  be  a  random  variable,,  an  averaged  measurement  can  be  defined  as 

y  a  Mx(t„)  +  q  , 


(3.24) 


whore 


9  =  '^(t,) 


S  =  -  r.'41ft1)«*>(t1;  t0> 


q  =  -  £q 
,  n 

n  -  number  of  measurements, 


the  technique  Just  described  was  Incorporated  Into  the  design.  Figure  12  compares  this  formulation  with  the 
normal  Kalman  formulation. 


4.  DESIGN  EVALUATION  AND  REFINEMENT 

Aa  already  mentioned,  evaluation  of  the  effect  on  system  performance  of  many  important,  apeclflo  areas  of  the 
baiio  Kalman  filter  design  lay  beyond  the  capabilities  of  any  existing  closed- formula  theory,  as  well  a*  those 
of  the  enaeaible  error  analysis  Programs  I  and  II.  These  areas  included  the  aingle-word  floating-point  arithmetic, 
approximations  to  tho  elements  of  the  transition  and  data  average  observation  matrices,  the  linear  approximation 
to  system  error  behavior,  and  tha  like. 

auah  evaluation  could,  of  oourat,  be  left  until  It  oould  be  accomplished  with  the  real  system  hardware,  aa 
soon  as  thla  became  available,  Howevar,  not  only  would  thie  kind  of  an  approach  be  highly  wastaful  of  prtolous 
development  tlmo,  but  aleo  -  hovvvar  carefully  designed  and  monitored  -  real  system  tests  can  rarely  provide  the 
kind  of  environmental  control  aaaeatlal  to  understanding  all-mode  system  performance  sensitivities  to  Individual 
effeots  such  aa  those  whloh  were  In  quest  loo  here.  The  considerations  led  tn  tha  development  of  a  digital  simu¬ 
lation  of  the  C-S  aircraft  navigation  system.  This  section  deeorlbea  this  simulation,  and  the  way  in  whloh  It 
wag  uied  to  evaluato,  validate,  and  refine  the  filter  design. 

4. 1  SlsMiletor  Description 

Simulation,  aa  tha  name  Implies,  la  only  an  approximation  to  reality.  Since  the  C-S  aiou' ntor  was,  in  fact, 
a  program  designed  far  use  In  a  general-purpose  digit  il  computer  (IPM  7000  or  3S0),  its  approximations  wers 
embodied  In  the  mathaeatloal  models  used  to  simulate  real  eyrtem  hardware  operation. 

figure  13  Is  a  functional  block  dlagrea  Illustrating  the  aajor  elements  which  are  required  to  simulate  tho 
navigation  system.  As  illustrated,  a  flight  profile  simulator  is  necessiry  for  generating  the  true  specific 
force,  f,(t)  .  acting  on  the  IkU,  and  for  eupplylng  to  the  measurement  simulation  the  true  position  and  velocity, 
danoted  by  the  vector  Z(t)  .  In  particular,  tha  flight  profllt  simulator  was  mads  aufflolantly  veraatllt  to 
simulate  taka-off.  landing,  orulst,  and  In-flight  aanauvers  of  the  C-S  airoraft. 

The  IMU  simulator  aooapti  the  true  apeclflo  foroe  from  the  flight  plan  simulator,  and  the  eomanded  platform 
torqulng  rataa  from  the  1031A  airborne  computer  simulator.  The  Kalman  filter,  which  is  a  part  of  the  10S1A 
simulation,  accepts  Information  from  the  simulated  Inertial  navigation  computations  and  from  the  measurement 
simulator,  and  faeds  back  correction*  to  the  navigation  simulation. 

*  The  tingle-cycle  tl«  of  only  10  seconds  used  for  genertting  Figure  11  results  see  bated  on  e  very  early  (lnrmroot) 
aseusptlco  shout  the  Kalaaa  filter  computet  inti  complexity.  For  corrcapondlni  results  tor  cycle  tine  sore  appropriate 
to  C-S,  eee  Reference  14. 

*  The  notation  hart  and  In  Figure  13  ha>  been  elapllfled  for  brevity  by  means  of  the  tysbols 

a  ‘  5  -  2  ,  y  •  T  -  f  ■  dy  . 
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4.  f,  1  INtl  Simulation 

tli#  WU  model  used  In  thu  simulation  program  la  illustrated  In  F'  14.  The  vector  7,  1*  the  truo 
epeoiflc  forco  obtained  from  the  Flight  Preflln  block  of  Figure  13,  mu  rntrix  ?p  „(t)  la  tho  transformation 
from  tho  coordinate  system  In  which  f,  la  computed  to  the  platform  refereneo  framo,  In  particular,  corruption 
of  the  apeolfio  force  vector  by  acceleromet.or-roUted  error*  It  *lmulatodu  an  ehown  aoroae  the  top  of  tho  figure 
(lee  elso  Figure  5).  and  reaulta  In  tho  measured  specific  force  vector,  f  ,  The  corruption  of  thu  commanded 
torqulng  rate  vector,  3C  ,  by  gyro-reletod  errors  Is  simulated  as  shown  In  the  remainder  of  the  flguro  (sen 
alio  Figure  T),  In  addition  to  the  gyro  error*  dleousscd  earlier  and  ehown  In  Flguro  T,  this  more  detailed  model 

Includes  a  breakdown  of  gyro  drift  rates,  ,  Into  bias,  programmed  time-function,  and  moss  unbalance  drift 

ratea.  Generation  of  these  for  the  l111  gyro  (1  *  1,2,3)  is  represented  In  thla  flguro  hy  the  box  ot  .  denota¬ 
tion  of  the  isms  unbalance  drift  rate,  in  particular,  requires  resolution  of  tho  specific  force  vector  Into  tho 
misaligned  input,  output  and  spin  axea  of  each  gyro.  This  la  accomgltahed  for  the  1th  (1  =  1,2,3)  gyro  by  the 
matrix  Tpi0,  ,  which  produuc*  the  resolved  specific  force  vector  fal  .  The  overall  resultant  rate  vector  to 
is  the  actual  Inertial  rotation  rata  of  the  platform  In  platform  reference  coordinates1, 

Updating  of  the  matrix  Tpljp  Is  done  in  t  separate  portion  of  the  program  In  accordance  with  a  sot  of  matrix 
differential  aquations1.  In  addition  to  to  ,  these  equations  also  require  as  Input*  the  components  of  the 
lnortlal  rate  of  rotation  of  tho  true  locally  tangent,  ldoul  wander  azimuth  angle  frttme  in  this  frame  itself. 

These  components  are,  In  turn,  generated  by  the  Flight  Profile  computations,  using  f,  resolved  Into  this  ldmil 
reference  frtrae. 

Some  of  the  simplifying  assumptions  built  Into  thla  simulation  wars: 

(a)  The  measured  specific  force  and  the  gyro  torqulng  rate*  are  continuous, 

(b)  Iha  inherent,  dynamic  instrument  lags  of  the  gyro  and  the  aoeolerometsri  art  negligible. 

(o)  The  dynamld  lags  of  the  platform  aarvo  loops  are  negligible. 

neat  simplifying  assumptions,  which  wars  mandatory  if  the  elmulatlon  were  to  run  at  afflolsnt  speeds  -  i.o. , 
much  faster  than  real  time,  were  aotlvatsd  by  the  fact  that  the  principal  natural  frequencies  of  martial  syatem 
trror  propagation  ar*  extremely  low  (e.g, ,  Schuler  frequency  1  cycle  per  84.4  mlnutea).  With  respect  to  these, 
the  lage  and  ainipllng  ratea  of  the  above  neglodted  effects  lay  in  ranges  which  wars,  respectively,  too  short 
and  too  high,  to  street  output  trrora  of  Interest. 

4.1.2  NDC-.W5U  Navigation  Equation  Simulation 

Figure  15  shows. soma  of  the. details  at  the  computations  performed  in  the  1081A  computer.  Al  already  disouaied, 
laboratory  calibrations  era  performed  on  each  1MU  to  establish  the  alamanta  or  the  calibration  vaotora  and 
matrices  shown  in  the  block  diagram.  .  For  aximple,  the  null  bias  calibration  will  cancel  the  effaots  of  vector 
afc  of  Figure  14,  except  for  error*  in  the  calibration  and  variation*  In  ub  caused  by  environmental  factors, 

Under  idealised  conditions  of  perfect  calibration,  with  reference  to  Figures  14  and  18, 
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Also  the  Utj]  matrix  and  the  oonetant  drift  rate  calibration  vector  product  a  commanded  drift  rate.  Thla 
will  exactly  oanoel  the  find  and  atatlo  saas  unbalance  drifts  of  ths  gyros  undar  the  Idealized  conditions 
This  type  of  calibration  “marries"  the  specific  (MU  and  ita  1081A  computer  ao  that  the  remaining  errors  era 
•mall.  These  same  matrices  are  used  in  tha  emulation  of  tha  C-S  aircraft  navigation  system.  Inputs  to  tha 
simulator  control  tha  assumed  calibration  errors  for  any  speolflc  oast. 

Tha  wandar  azimuth  equationi  ara  solved  by  numerical  integration,  ho  attempt  ie  aade  to  simulate  any  part 
of  the  actual  10S1A  arithmetic  for  tha  operations  shown  in  Figure  IS,  Parallel  etudiee  in  tho  development  of 
the  real-time  program  had  shown  that  the  errors  Introduced  by  thla  asaumption  art  insignificant. 

4.1.J  Kalman  filttr  Simulation 

Rather  than  attempting  to  daalgn  an  all-mode  simulator,  different  versions  of  ths  simulated  Kalman  filter 
sub-routine  tire  programmed  for  aaoh  node  under  study,  This  approach  was  usad  to  reduce  complexity  and  run 
tlma,  Also,  apaclal  voralona  ware  developed  to  iiolatt  cause*  of  certain  problem  areas.  For  aximple,  versions 
with  and  without  tha  14-bit  arlthmatlo  mentioned  below,  and  with  and  without  data  averaging,  ware  oonatruotad. 

For  final  validation,  the  sequence  of  calculations,  the  14- bit  float ing-point  arlthmatlo,  and  all  othar 
factors  were  simulated  to  a  high  degree  of  realism.  To  thla  and,  a  special  laohina  language  sub-routine  wae 
-ooetructed  for  masking  the  7090  word  to  ilmulit*  the  14-bit  floating-point  arithmetic.  This  simple  sub-routin* 
la  used  in  tha  appropriate  computations  to  lntroduo*  tha  additional  errors  caused  by  the  14-bit  floating-point 
arithmetic,  Dilative  aart  waa  usad  in  tha  order  of  calculation  to  prtiarve  as  much  oocureoy  as  possible.  Thee* 
program  details  were  later  usad  in  the  real-time  program  for  the  asm*  purpose, 


All  valpei  of  til  the  controllable  quantities  (for  example,  the  constant*  of  the  It  matrix,  the  value  of 
the  '  *  (tin  ftotor,  the  vnrlnnoc  of  the  random  error  in  observation,  tto.)  tri  controlled  hy  Input  tnd/or  over* 
lay  of  block  dttt  Observation  soquunecs,  Kalman  ojrolt  t lmo .  etc.,  are  also  Input  In  t  similar  manner. 

4,1.4  Otewrpelion  Simulation 

Tlit  obitrvttlon  tlnulttlon  models  necessary  for  the  various  morion  of  study  were  nmdo  t  part  of  the  Kalman 
filter  sub-routine.  Models  sere  simulated  as  realistically  as  possible  to  Include  all  the  relevant  error 
tourott,  Those  errors,  which  could  only  be  described  by  t  rundnm  process,  wurs  included  by  uelng  t  selected 
staple  or  stmplei.  Thle  was  Justified  on  the  basis  thit.  the  prinnry  purpose  of  the  ulmulstlon  wan  to  dotsot 
and  correct  aijnr  problems.  Once  problem  truss  are  corrected,  the  real  ayatem  should  behave  In  a  reaeonubly 
linear  tanner  aa  far  as  the  error  propagation  la  concerned. 

4.1  Example  Uses  of  the  Slmulstion  Program 

It  should  bd  rosiiouably  clesr  from  the  precodlni  discussion  that  the  digital  computer  simulation  procram  is 
not  only  quite  versatile  but  can  also  be  readily  modified.  By  means  of  appropriate  Input  data,  values  can  be 
■sleeted  for  quantities  controlling 

(s)  the  flight  plan, 

(b)  the  Initial  emirs, 

(o)  the  constant  and  time-varying  IMU  errors, 

(d)  the  obesrvstlon  sequence  and  the  Kalman  cycle  tine, 

as  sell  as  asny  others. 

To  s  novice,  euoh  versatility  posts  s  problem  of  mhere  to  begin.  This  problem  can  be  beet  addressed  hy  simply 
missing  shat  ths  program  sas  dealgnad  to  test.  Ths  possible  problem  trass  in  the  kaluen  filter  oould  be 
espeoted  to  fall  In  ths  following  categories: 

(a)  Nonlinear  phenoaena. 

(b)  Numerical  Inaccuracies  and  problems. 

(a)  effects  of  Inherent  computational  delays. 

(d)  Vnmodeled  or  Improperly  modeled  errora, 

(a)  Approximations  in  the  equations. 

It  sas  thsrefors  planned  to  set  up  computar  runs  rtssigned  to  axsrolse  the  elmulxted  filter  In  s  soret-oame 
sense  with  respect  to  eaoh  of  thsee  categories.  Analyele  of  the  resulting  data  would  then  uncover  problems,  if 
present.  Although  selection  of  a  worst  ease  Is  by  no  mean*  a  simple  problem,  tneory  own  be  need  to  provide 
sensible  guidelines.  Cor  example,  the  baslo  design  la  beasd  on  linear  thsoiy.  Hanoi,  one  of  the  first  questions 
1*  “bos  linear  1b  this  system?".  To  obtain  the  answer,  the  simulator  was  used  to  gonarate  tlma  hlatorica  of 
actual  navigation  eyatea  error*  for  various  seta  of  initial  trrore.  iheae  were  compared  to  errors  predicted  by 
the  transition  mttrlx  In  acoerdenae  with 

*<t)  «  $(t;t,)i(t0)  . 

These  runs  validated  that,  for  all  practical  purposes  (l.e. ,  within  ream  nable  values  for  r(t.)),  the  system 
errors  propagate  linearly.  Similar  cheeks  were  aide  on  the  measurement  functions.  These  slec  Indicated  that 
ths  rtslduals  were  linearly  related  to  eetlmste  errors  far  ell  preotiosl  purposes,  Hence  the  linearity  assump¬ 
tion*  had  bssn  provsd  sound, 

In  oheoklng  ths  rtmslning  areas,  s  two-step  process  was  generally  adopted: 

(a)  Demonstration  that  the  filter  behaved  normally  when  the  only  .rrore  in  the  ayatem  were  those  Included  in 
the  filter. 

(b)  Adding  unmodeled  errori  to  determine  degradation  in  performance  or  thd  existence  of  otherwlee  hidden 
problem! . 

4.2. 1  Fini  Ground  Align  Modo  Dotcription 

The  purpose  of  the  fine  ground  alignment  mode  is  to: 

(a)  Precisely  level  the  platform.  Pletfon  deviations  from  level  are  called  tilts. 

(b)  Obtain  accurate  coincidence  between  platfon  and  computer  aslmutha.  The  difference  between  the  azimuth* 

1*  oalled  a  headlni  error. 

(o)  Preoleely  eitlmat*  drift  rates  of  the  level  channel  gyros  (gyros  3  and  3). 

The  flue  ground  align  mode  starts  attar  10  nlnutes  of  wera-up,  during  which  time  oniric  alignment  of  the 
platform  la  aosompUahed.  At  tha  utart  of  fine  ground  alignment  the  platform  la  thus  reasonably  oloee  to  its 
desired  attitude.  Tllte  are  fraction*  of  a  degree,'  and  coarse  gyrn-oemraseing  has  reduced  the  heading  error  to 

a  few  degrees, 
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Figure  10  In  a  simplified  schematic  nf  tno  npo ration  of  a  single  level  channel  during  fine  ground  alignment. 

Ag  Illustrated,  the  accelerometer  on  the  platform  senses  a  tilt  proportional  to  gravitational  foroe  times  tho 
sine  of  the  tilt  anglo  d>  .  tlie  velocity  register  output,  v  ,  will  ramp  as  n  result  of  tho  tilt  angle. 

Because  of  platform  drift  rate,  nn  approximate  quadratic  effect  (In  time)  will  also  exist,  as  shown  In  Figure  17. 
The  total  output  shown  la  the  aura  of  the  two  effects, 


The  dnta  averaging  dencrlhrd  anrller  sienplus  the  velocity  register  at  a  high  rate  to  accumulate  an  nveruge 
reading.  At  45  seconds*,  this  average  Is  Input  to  tho  Kalman  filter,  which  computus  estimates  of  the  atute 
•rrors,  llowover,  because  of  the  time  required  for  th»tr  computation,  those  estimates  aro  not  appliod  until  the 
and  of  tho  aucoml  cycle,  At  this  time,  tho  velocity  roglstor  la  roRot  to  a  small  value  by  thn  estimated  voloclty 
error,  and  leveling  rata  and  platform  drift  rate  csclmuhoa  are  also  applied. 

During  thn  third  o,vc!e,  tho  platform  Is  almost  perfectly  leveled  by  the  commanded  leveling  rnto*.  In  subse¬ 
quent  cycles,  tho  residual  quadratic  sawtoothing  nf  the  voloclty  register  in  steadily  reduced  as  the  platform 
drift  rate  is  more  and  more  accurately  estimated  and  compensated. 

During  tho  operation  Just  described,  tho  platform  la  held  in  a  Dingle,  flxcd-aalmutli  orientation  which,  to 
facilitate  tho  dlecusslon,  Is  here  taken  us  cardinal  (l.o, ,  the  platform  axes  are  aligned  approx Imately  north 
and  east),  In  this  orientation.  the  filter  after  a  short  time  forces  tho  platform  into  a  steady-state,  level 
condition  in  which,  although  tno  input  axis  north  gyro  drift  rate  has  been  accurately  calibrated,  tha  Input  axla 
tut  gyro  hat  not.  Instead,  the  platform  (and  therefore  the  input  axis  nf  thla  gyro)  has  a  heading  error  Junt 
auffloient  to  ooupla  enough  of  the  Earth* t  rutation  rate**  into  thla  gyro  to  oancel  its  drift  rate.  Thus,  after 
■lngle-poaltlon  gyrecompaaalng,  aa  Che  above  operation  la  oallad,  both  a  algniflcant  heading  error  and  an  onnt 
gyro  drift  rate  remain,  although  the  total  platform  drift  rata  about  the  east  axla  la  compensated. 

To  remove  these  Important  residual  errara.  two-position  gyrocompanslng  is  employed  for  C-8  fine  ground  allgn- 
■ent.  That  la,  gftar  a  8-  or  7-mlnut*  period  In  tho  f 1  rat  position,  the  platform  la  alawed  BO  degreea  In  azimuth, 
and  the  firgt-poiltlon  proeesa  li  negated,  Because  of  the  reorientation  of  the  level  gym  Input  axea,  however, 
the  heading  error  la  rtmoved,  and  the  Input  axle  tut  .(now  north)' gyro  la  also  calibrated  during  this  acoond 
operation. 

U,  2,2  Nominal  ftesulfx  of  Fine  Ground  rlh'gn  Mode  iSiaulalion 

Tho  Kalman  fin*  ground  alignment  toohnluun  Juut  described  1*  must  taaily  evaluated  when  no  nniaodeled  errora 
V*  Included  In  the  almulatlon  run.  Thla  la  boeauao  unmodeled  errora  produce  extra  error  effects  at  the  modeled 
variable  level*  which  unfortunately  do  not  behave  In  accordance  with  the  filter  model.  Pur  example,  a  eoale 
■factor  arror  In  the  input  axla  north  gyro  In  the'firet  position  produoea  an  apparent  fixed  drift  rate  about  the 
north  axle  (In  the  horizon  plant),  due  to  the  torqulng  rate  applied  to  thle  gyro  to  counter  the  Earth's  rotation 
rat*  In  thla  direction,  Thla  la  duly  compensated  by  the  filter  In  tha  first  position  by  means  of  e  fixed  rc-blaa 
rate.  After  repositioning,  however,  thla  acala  factor  affect  it  absent,  since  no  Earth  rate  compensation  torqulng 
la  applied  to  this  gyro  when  lta  input  axla  la  want.  Howevar,  the  compensating  r*-blis  rata  remains  to  produce 
an  trfectlv*  drift  rata,  and  therefore  a  balancing  heading  error,  in  the  second  position. 

Since  such  effeati  would  unneasiaarily  complicate  the  evaluation  of  performance  elth  respect  to  other  apnolflo 
filter  design  areu,  unmodaled  trrora  were  not  Included  In  the  simulation  runs  used  to  avaluate  tha  fin*  ground 
alignment  filter  design  until  the  design  had  been  essentially  completad  and  validated. 

In  addition,  in  order  to  establish  a  fixed  frame  of  rsfartmee  for  comparlaona  botween  runs,  a  single  eet  of 
nominal  value*  for  modeled  errors  wu  used,  as  well  a*  a  nominal  alignment  configuration.  Speolfloally,  all 
runs  simulated  two-poaltlon  fin*  ground  alignment  at  48  degrees  north  latitude,  with  the  Input  axes  of  gyro*  2 
and  3  repaaotivaly  tut  and  north  In  tha  first  position,  and  north  and  west  in  the  final  position.  The  tine 
spent  in  each  position  was  about  7  minutes,  which,  together  with  the  1-minute  slew,  accounted  for  the  overall 
maximum  goal  of  18  minutes**.  As  to  modeled  errors,  initial  tilts  about  axea  3  and  3  were  assumed  to  be  respec¬ 
tively  -0.33  and  40.40  d<  grse,  gyro*  3  and  3  wars  stch  aaslgnsd  a  40.03  degree  per  hour  drift  rat*,  and  the 
platform  heading  error  was  Initiated  at  43.0  degree*. 

Figure*  1B,  10,  and  20  aummarue  the  results  of  a  almulatlon  run  with  this  nominal  configuration,  after  moat 
of  tha  major  problem  arts*  had  haen  Ironed  out.  In  particular,  Figure  18  la  the  simulated  time  history  of  the 
north  valualty  register  for  this  run,  The  reaps  due  to  the  Urge  initial  platform  tilts  In  each  position  ar* 
evident.  The  velocity  error  due  to  this  tlft  la  largely  removed  at  the  beginning  of  the  third  Kalman  cycle  In 
•ach  position,  baaad  nn  the  average  of  the  velocity  data  collected  in  tha  first  Kalman  cycle.  Baaed  on  the  asm* 
data,  the  initial  tilt  la  also  acourataly  estimated  and  largely  removed  hr  the  application  of  an  appropriat* 
platform  levallng  rat*  during  the  third  cycle.  In  aubaequent  cyolea,  the  drift  rate  and  it*  tilt  and  velocity 
error  affects  art  gradually  aHtlmated  and  rtmovad. 

*  nls  wu  the  expected  duration  of  the  final  Kalaut  cycle  tla*  aidwty  la  the  developaeat.  It  tu  reduced  to  33.8  eeooodt 

later  la  the  progru. 

*  Tble  leveling  la  reflected  la  the  velocity  register  reeding*,  ehoet  Instaataneoua  elope  ie  proportional  to  the  lnatu- 

teneoui  tilt  of  the  platfor*. 

'•  specifically  the  aortbeard  component,  In  the  horizon  plane. 

**  hr  laveatliattun  purpoaai,  operation  In  the  eeosml  position  ess  often  extended  beyond  18  wlnutae  overall,  end  alignment 

performance  In  Inter-nardlnsl  orientations  of  ths  platfor*  ears  also  exulned. 


. 


'a*  "  '*«w**» 

I  ■.  “  a  "  t,  *  ka  *■  ,7 

X  1  «  *<  ,  *  ,  'a  S  **  *  S  • 

’  *  X  *  a  ’  i  ‘  1  '  V% 

4  •*  11  .  '  q  H  B  *•  ^ 

w  "  \*m  n^*  ^ 


Vy*  ***  S  "*  te  1  “  •• 

.--y\ 

,V  > 

V'  • 

X  *t»  *  •  *»  ■■  •  • 

■/«  -AO  r-v-v 

I  *  *  1  •  »-  *  .  *  |g  j 


"o  J,"  O  3 


y.;  j 

•  •<». V,  •' 

.•  \  y.yw  .  - .  < - ■  < 

.  ^  ,  V  ,  *  ’•^'e*  *(,**  »* 

.V-V'V'V’  j 

MA  h\  •  la  tH< •#A 

i V  «  ,  -  u  ,  «|  4  - \  «r 

V' 

vVVvV ‘,k 

•  v- 

V  >  V  ■*  V  ‘A1 

V-  e*‘V-  . 

«V  V*  •xa-  V-  -  - 


.'•‘.’A  *  s“’  .‘v/v 

.  ■*  ,  *  -hn  a 


8MRNHK 


312 


l. 


Although  velocity  And  platform  tilt  errors  ire  thu«  qi/lckly  removed,  cetlbntlon  of  the  level  gyro  drift  rites 
ind  removal  of  tho  heading  orror  li  i  much  slower  prooen.  Thlu  is  llluatrntod  In  Flguros  18  and  30,  from  which 
It  la  evident,  In  particular,  that  significant  calibration  of  the  numbor  2  lovol  gyro  drift  rate  is  still  pro¬ 

ceeding  it  thi  mil  of  tho  allotted  IS  minutes  of  alignment  time*. 

4.?,.)  Efficti  of  Large  UrMotltled  Error $ 

Rarly  laboratory  results  for  the  ground  align  mode  were  obtained  before  tho  calibration  constants  of  Figure  10 
were  available.  Flguro  21  shows  a  typical  time  history  of  the  north  velocity  register  obtained  from  the  actual 
system  at  that  time,  Comparison  with  Figure  IS  shows  that  the  behavior  of  the  real  system  was  fsr  from  nominal. 
It  was  recognized,  however,  that  largo  unrodelod  errors  could  easily  produce  auch  performance,  since  tho  final 
ayatem  would  bo  preenlihrated,  there  was  little  need  for  concern  If  th*  effects  seen  in  Figure  21  were  Indeed 
caused  hy  these  errors,  • 

Tho  simulator  was  used  to  confirm  this  hypothesis:  Figure  22  shows  the  north  velocity  timn  history  obtained 
from  a  simulated  fine  ground  alignment,  for  which  large  uncalibrated  scale  factor  errors  on  tho  gyros  wore 
assunod.  Tho  unmistakable  similarity  between  the  simulated  and  actual  voloclty  reapunsuH  In  Figniun  22  and  21 
gave  some  oonfldenco  that  the  Irregularities  observed  In  the  real  system  results  wore  In  fact  rauned  by  Its 

lack  of  calibration,  rather  than  any  filter  design  deficiencies.  In  particular,  It  la  evidont  that,  in  each 

case,  the  platforsi  woe  not  adequately  leveled  by  the  command  rats  applied  during  the  third  cyola.  In  the  simu¬ 
lation,  this  was  known  to  hava  been  caused  by  the  large  (18%)  gyro  aoila  footer  error,  whloh  produced  a  net 
livtllng  dlaplaaement  of  the  platform  during  this  cycle  which  was  10%  larger  thin  that  commanded.  The  reaultlng 
Irregular  behavior  of  thi  almulatid  system  provided  a'  unique  aigttatura  which  was  uatd  in  this  out,  as  well  as 
throughout  Igtsr  phasos  of  system  teat,  tc  identify  problems  due  to  look  of,  or  to  faulty,  system  calibration, 

4.2.4  Problem*  Caused  by  Ibt  14-Bit  Floating-Point  Arithmti ie 

An  mentioned  earlier,  several  versions  of  the  sub-routine  which  simulated  the  on-board  filter  computations 
wire  available,  This  mad*  It  possible  to  address  the  overall  problaa  In  a  rsaaonably  orderly  mannor.  For 
example,  It  was  first  established  that  satlafeotory  result!  were  obtained  with  the  single  precision  floating¬ 
point  7080  arithmetic  (28  bite  and  sign),  before  eimulstlng  the  14-bit  arithmetic, 

It  was  also  suspected,  on  the  basis  of  prior  axperlttici,  that  there  would  likely  be  problems  in  maintaining 
a  positive  definite  oovarlanea  matrix.  As  dtioribed  earlier,  however,  two  teolinlquea  Tor  combating  potential 
numerical  problems  and  unmodeled  errors  had  been  provided1.  To  recapitulate,  these  two  techniques  were  the 
addition  of  the  R  matrix  la  ths  time  updete  operation' 


P(t)  m  4p(t4)4T  +  R  , 

and  the  “epsilon"  technique  In  the  measurement  update  operations: 

F.  «  F  -  FRTRP/(«,IIT  rO)  t  «t[eV<Mni',+C)3li 


(4. 3) 


(4.4) 


Neither  of  these  techniques,  however,  could  provide  a  satiifaotory  solution  to  the  numerical  problem  that 
oaourrad  u  a  result  of  the  use  of  tha  proposed  14-bit.  floating-point  arithmetic.  Ibis  was  the  loes  of  posi¬ 
tive  diflnlteneii  (1. e, ,  tha  oaeurrenoe  of  nugstlvs  dir tonal  taros)  in  th*  oovurlanoe  matrix  on  the  first  or 
■econu  filter  oyolwi  In  th*  sinulated  fine  ground  alignment  mode.  The  problem  did  not  occur  Initially,  when 
the  standard,  Kalman  dliorsta-atasurement  formulation  was  simulated,  but  only  lstwr,  tho  first  time  the  new, 
averogsd-neasuraoent  formulation  was  tried.  Title  tended  to  olnud  the  fundaments!  source  of  dlffioulty.  Previous 
experience  had  definitely  indicated  that  th*  moet  likely  problem  area  would  be  in  the  exsoutlon  of  Equation  (4.4), 
Th*  prlnalpal  ohangse  in  thli  equation  Introduced  by  the  avertged-meniurement  formulation  ware 

(i)  tha  M  vector  had  more  non-zero  elements: 

(b)  the  0  joslar  (variance  of  the  rindem  error  In  measurement)  was  significantly  smaller. 

Ones  theg*  factors  were  recognized,  the  value  of  MPMT  tat  compared  with  th*  value  of  C  .  The  problem  was 
then  Immediately  recognized.  C  was  so  small  that  early  in  th*  eequeno*  (when  P  Is  large)  It  wai  effectively 
iero*  with  reapeot  to  addition  to  NPMf  ,  Also,  the  third  berm  of  Equation  (4.4),  which  contains  tha  "epsilon” 
gain,  was  affeotlvsly  zero*  In  comparison  to  th*  second  term. 

Increasing  either  «  or  C  to  prevent  the  difficulty  was  not  reasonable,  The  results  of  aueh  lnoreasea 
would  prevent  good  uatlmitlon  later  In  ths  messursaent  sequence,  Perhaps,  In  retrospect,  an  SRiropriate  oboice 
would  have  been  to: 

.  (a)  Teat  If  C  <  kHPNT  . 

(b)  If  true,  assign  (MPNT+C)  =  ( 1  +  k)KPKT  .  where  th*  quantity  k  could  be  selected  somewhere  In  th* 
rengt  0.001  <  k  <  0.1  . 


*  However,  the  lsvtl  of  csUbrstion  achieved  in  thle  tin  was  sort  tkaa  adsqustw.  This  wax  sstabllthtd  by  tbt  wiosllwnt 
tnrtlal  navigation  ptrforwuoi  (not  shown)  aohlsvtd  in  a  tlaulatlne  of  a  flight  following  this  allgnmint. 

*  t.e, ,  1*ii  than  tht  list  bit  in  ths  14-blt  riglatsr. 
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Th«  »otu»l  choice  used  wan  to  assign 

(HTMt  +  C)  =  <1. 01)  4  c  , 

Hi#  1.01  factor  provontod  loan  of  punitive  dtiflnitoneas  early  In  the  aoquonco.  Later  monnuromeiitn  were 
weighted  (lightly  less  than  optimally,  but  the  performance  loas  wan  email  In  comparison  to  that  produced  by 
other  factert  (e.g, ,  unmodeled  error  sourcos). 

4. 5.5  Tht  Approximate  Irani 1 1 1  on  Matrix 

The  tranaltlon  matrix  for  the  tlmi- varying  lluoar  variational  aquation 

ait)  =  A(t)x(t) 

aaa  to  be  approximated  hy  the  formulation  given  In  Equation  13.181.  Two  potential  prublemB  were  evident  in  thin 
exp  ana  Ion: 

(1>  Were  the  eecond-ordor  terms  retalnnJ  sufficient  for  adequate  prediction  across  the  Kalman  Interval? 

(3)  Could  the  non-conetant  portion,  ABC  ,  of  the  A  matrix  be  treated  ae  a  constant  serosa  the  Interval? 

In  tho  ground  align  mode  tha  matrix  A  la  constant.  Hence,  one  of  the  early  uses  of  the  simulator  wun  to 
varlfy  the  adequacy  of  Equation  (3.19)  for  uac  In  this  mode,  This  Investigation,  quickly  completed,  resulted 
in  the  addition  of  a  few  more  selected  second-order  (constant)  tains  to  the  elements  of  the  original  formulation. 

In  tha  case  of  airborne  mods  filter  operation,  tha  question  is  to  whethur  or  not.  ths  non-constant  elements 
of  A  could  be  treated  as  constant*  across  each  Kalman  Interval,  required  a  muoh  mar#  extensive  Investigation 
with  tha  simulator.  Thla  was  because  results  in  this  area  wars  (net.  surprisingly)  found  to  depend  strongly  on 
(a)  the  nature  and  axtent  of  the  particular  maneuvers  assumed,  (b)  ths  Kalman  cyole  time,  and  (c)  the  order  In 
whloh  filter  operations  were  carried  out  (see  Table  I), 

At  the  time  of  writing,  theai  Investigation#  were  sasentlally  complete,  and  tha  oonatancy  assumption  had  bean 
proved  valid,  subject  to  certain  condltloua  on  the  above  faotor.a  which  were  realisable  In  the  C-P  application. 
However,  any  detailed  discussion  of  this  arts,  which,  It  is  to  be  aotsd,  has  general  Importance  fnr  beyond  the 
C-8  application,  la  outatde  tha  acopa  of  thie  chapter. 

4,3  Ululated  0 round  Align/Barometric- Inertial  Performance* 

Figure  33  ahows  the  gyro  calibration  history  for  a  simulated  fine  ground  alignment,  in  whloh  all  errora 
bellaved  to  b«  significant  (modeled , and  unmodalsd)  wars  included.  In  this  csss,  unlike  that  of  Figure  IS  whsrs 
only  lodslsd  system  errori  were  included,  the  final,  steady-stats,  level  gyro  compensation  valuea  attained 
rapressnt  lumped  compensations  far  ths  combined  sffsots  of  gyro  bias  drift  rates  and  the  effective  drift  rates 
produced  by  gyro  scale  factor  and  Input  axle  alignment  calibration  matrix  errora. 

It  Is  evident  from  Figure  23  that  sasentlally  no  calibration  of  tbs  number  1  (azimuth)  prro  drift  rata  Is 
attained  in  the  ovirall  13-minute  tint  alignment  mods  ptrlod.  This  Is  beoauas  toe  sensitivity  of  ths  level 
velocity  register  averages,  whloh  ars  ths  Kalman  filter  Inputs  In  this  mods,  to  azimuth  drift  rates  la  oon- 
•idsrably  less  than  it  la  to  level  drift  ratss.  This,  however,  Is  a  limitation,  not  of  the  „ilman  filter  ipproaoh, 
but  rather  of  the  basic,  two  (levsll  position  tyrooemptssins  technique:  no  other  filter  type  could  (statistically) 
produo*  s  significant  azimuth  drift  rate  calibration  within  ths  15-mlnute  alignment  time  using  ths  same  position¬ 
ing  Mquano*  and  gsumetry. 

Floe  alignment  performance  In  the  preesnnr  of  the  unmodalsd  gyro  error*  can  only  be  honestly  evaluated,  by 
simulation  of  follow-on  baroaatrlo  Inertial  flight.  Ths  goal  (at*  Section  2)  is  a  barometric-inertial  navigation 
OOP  growth  rats  during  tan-hour  flights  of  no  larger  than  0.73  nautical  mile  per  hour  during  the  first  five  hours 
and  1,38  nautical  mlUs  per  hour  In  the  second  five  hours. 

Figure  24  gives  the  navigator  performance  In  tens  of  tha  sctual  tas*  and  west  position  trrora  that  aooumuJatsd 
tar  thla  particular  act  of  unmodalsd  gyro  errors.  Shown  also  are  ths  ''snssmbl#"  results  taken  from  the  Kalman 
filter  oovarlsno*  matrix.  This  was  a  simulation  of  a  barcnatrlo-insrtlat  flight,  starting  at  48  degress  latitude, 
accelerating  suit  to  800  ft/sso  horizontal,  velocity,  climbing  to  33, 000  fast  altitude,  and  thereafter  cruising 
at  constant  altitude  and  speed  on  a  great  olrols  path,  it  is  seen  in  ths  figure  that  the  actual  tut  position 
error  exceeds  tht  standard  deviation  obtained  from  ths  Kalman  filtir  covariance  matrix.  This  was  not  unexpected 
because: 

(a)  The  18-by-lS  Kalman  fUtar  covariance  matrix  doss  not  include  all  ths  error  sources. 

(b)  Tha  staple  errors  chosen  war*  larger  than  would,  on  average,  be  obtained  froa  a  statistical  sample. 

The  overall  trends  of  the  two  curves  (actual  and  stsndsrd  deviation)  have  ths  stae  behavior.  This  gives  con¬ 
fidence  that  ths  simplifications  used  in  th4  filter  ars  appropriate  for  long-time  propagation. 

*  Vis  vertical  channel  of  t  thres-degrees-of- freedom  free- inertial  navigator  Is  unstabls.  For  the  C-5  navigator,  stability 
la  malntalntd  by  ualng  the  seneraUied  all-aode  Kalian  filter  with  an  altitude  observation  based  on  the  beroeetrlo 
altimeter.  Therefore,  thle  mode  of  operation  Is  referred  tn  as  "baromstrlo-insrtlsl"  instead  of  fist-inertial, 
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Previous  enasmble  analysis  hsd  ahown  ttiot  straight  flights  produce  slightly  worse  barometric- Innrtlal 
performance  than  flights  which  have  turns.  It  was  thereforn  decided  to  tstahllnh  a  flltht  that  lnuludnd  a 
turn,  aa  a  further  tost  for  the  filter  In  tho  barometric- Inert lal  mod*. 

The  path  choaon  wan  a  level  acceleration  in  the  north  direction  to  600  tt/wee,  simultaneous  with  a  climb  to 
33,000  feet.  This  was  followed  by  crutne  for  06  mlnutos,  then  a  00-dogree  right  turn  taking  60  seconds,  and 
finally  a  Ion*  terminal  great  circle  cruise  on  the  new  leg  at  600  ft/aee,  Figure  20  glvns  the  navigation  results 
for  these  conditions.  Alignment  and  error  conditions  were  Identical  to  those  used  In  obtaining  the  reaulta  of 
Figure  34. 

Aa  oan  be  seen  In  comparing  Figures  24  and  26,  tho  actual  errors  are  slightly  smaller  for  the  lattov.  nils 
la  a  (ont-case)  confirmation  of  the  date,  obtained  from  the  ensemble  analysis  programs. 

An  Interesting  property  of  the  results  of  Figures  24  and  23  la  that  austalned  oscillations  at  both  earth  rate 
frequonoy  and  Schuler  frequency  are  coutalnod  in  the  errors.  This  Is  psrttcularly  avldont  In  tho  north  position 
error  time  histories.  Tho  approximate  arror  model  used  In  the  Kalman  filter  reflucta  these  same  oscillations 
and  retains  a  fairly  good  phase  relationship.  Thin  glvos  confidence  that  tho  entire  Kalman  filter  error  covariance 
matrix  (loon  remain  a  good  model  of  tlio  actual  seta  uf  error:,.  This  Is  not  too  important  for  fine  alignment 
followed  hy  otherwise  unaugmnnted  barometric-  Inertial  operation  In  tho  subaoqnent.  flight.  If,  howovor,  addi¬ 
tional  data  such  as  a  I, ORAN  position  fix  becomes  available  later  in  the  flight,  correct  woightlng  of  the 
observation  to  improve  navigation  and  to  calibrate  the  IUU  depends  on  the  validity  of  the  cnvarlanoe  matrix, 

4.4  Laboratory  Teat  of  around  Allgn/barometrlc-tne:  usl  Performance 

Reliable  confirmation  of  the  design  of  the  C-S  Kalman  filter  in  the  fin*  ground  align  mode  of  operation 
became  possible  for  the  first  time  only  when  the  IUU  praeallbratlon  program  checkout  was  completed,  and  this 
program  became  available  for  ue*  In  determining  the  gyro  and  accelerometer  error  compensation  matrix  element* 

(•**  Section  4. 1). 

Thl*  allowed  laboratory  ayatem  fin*  align  teiti  to  be  conducted  for  the  first  time  with  calibrated  IMU' s. 

Since  filter  design  hsd  betn  predicated  from  the  start  on  tho  use  of  auoh  precalibrated  IMU' a  and  quite  a  few 
simulation  results  Incorporating  this  assumption  wars  already  available,  extensive,  dlraot,  and  meaningful  com¬ 
parisons  bstwsen  aotual  and  simulated  performance  could  now  be  carried  out. 

Figure*  26  and  27  ahow,  respectively,  the  east  velocity  regieter  and  the  drift  rate  compensation  historian 
during  typical  laboratory  system  fin*  align  testa  with  calibrated  IMU'  *  at  this  stag*  of  the  program. 

Comparison  of  Figures  26,  21,  and  18  reveal*  tbat  IMU  calibration  had  removed  the  mis-oodsUng  difficulties, 
the  effeota  of  which  are  evident  in  Figure  21,  eo  that  voloclty  register  behavior  of  the  calibrated  system  was 
vary  similar  to  that  shown  In  Figure  18  for  a  simulated,  ptrftctly  precallbrated  ayatem. 

Comparison  of  Figures  27  and  23  further  substantiates  that  the  (lA-varlablo)  filter-incorporated  eyeteu  error 
model  warn  adequate,  ae  indicated  by  the  highly  ilmllar  simulated  and  laboratory  ayatem  test  results  shown  for 
the  gyre  drift  rate  compensation  histories  during  ground  tllga, 

In  addition,  ths  laboratory  tint  dsploted  in  Figure  27  was  extended  (as  shown)  to  establish  azimuth  drift 
rat*  (gyro  1)  compensation  behavior  if  more  alignment  time  were  available  in  a  real  C-B  operational  situation*, 

It  was  evident  that,  despite  tho  weak  sensitivity  Involved  in  extracting  azimuth  drift  rate  Information  from 
level  velooity  averages,  couplets  calibration  oould  nevertheless  be  accomplished  In  about  half  an  hour*. 

Finally,  Figure  28  shows  the  Inertlsl  navigation  performance  of  a  typical  laboratory  ayatem  following  nominal 
(l.e, ,  18-minute,  two-position)  tine  ground  align.  The  excellent  performance  (relative  to  the  performance  goal 
of  0.78  nautical  mile  per  hour  for  the  first  fivs  hours  (lei  Section  2.3))  shown  hers  wss  a  strong  overall  con¬ 
firmation,  beyond  that  obtainable  from  operation  In  tbs  fin*  align  mod*  only,  of  filter  design  adequacy, 

4.8  Flight  Teat  of  around  Allgn/Beroaetrlo-Inertltl  Performance 

Although  result!  (such  as  that  shown  in  Figure  38)  clearly  demonstrated  adequate  performance  of  the  C-S  filter 
design  for  ground  align  In  tho  liboratory,  and  proved  a  high  degree  of  confidence  for  ite  expected  performance 
In  this  mode  in  the  field,  demonitrated  field  capability  oould,  of  course,  only  be  obtained  In  aotual  flight  teat. 

At  the  time  of  writing,  performance  results  obtained  from  the  first  eerlea  of  flight  te«t*  have  confirmed 
not  only  the  adequacy  of  filter  deelgn  for  fine  ground  alignment,  but  for  barometric-inertial  navigation  aa  well. 

In  addition,  these  result*  ht'.e  given  a  high  degTe*  of  confldeno*  that  the  design  will  also  prove  adequate 
In  the  remaining  ayatem  modes  of  fl' ter  operation,  which  will  be  evaluated  In  the  test  program  phase*  now  being 
entered. 


*  Calibration  of  tbs  azlsutb,  ae  well  aa  the  level  gyro  drift  rites,  provides  tree  better  eubeequeot  laertlel  aevlgstlon. 

*  Ibis  bad  been  predicted  by  earlier  simulation  reaulta  (not  shown). 


S.  SUMMARY 


The  C-5  Kelran  filter  software  davelopnent  effort,  which  has  besn  outlined  in  this  chapter,  resulted  In  a 
final  design  which  was  optimum  in  the  practical  sense  that  it 

(a)  set  the  software  performance  specifications; 

<b)  fitted  into  the  real-time,  oil-board  computer; 

(c)  set  the  pertinent,  overall  software  development  schedules, 

TO  the  extent  possible,  modern  sample-data  estimation  and  control  theory  was  not  only  used  in  developing  the 
design,  but  in  acme  areas  actually  extended  (e.g. ,  tho  "epsilon"  and  averaxed-moasursment  techniques),  However, 
at  is  typical  of  moat  practical  problems,  in  a  few  areas,  because  theory  was  inadequate  or  development  time 
limited,  approximate  solutions  had  to  be  constructed,  based  on  engineering  Judgment  end  experience.  Much  of 
the  development  effort  was  devotod  to  the  construction  and  use  of  the  three  major  error  analysis  and  uystem 
simulation  programs  (Programs  I,  II,  and  III).  Those  programs  wore  used  to  validate  or  reject  alternatives  at 
almost  every  major  filter  design  doolslon  point  throughout  the  program.  Costly  redesign  and  tape  reprogramming 
efforts  lete  in  the  system  development  wore  thereby  avoided.  Program  II t.  In  particular,  also  proved  an  Invalu¬ 
able  tool  for  isolation  and  correction  of  both  hardware  and  software  "bui.V  during  system  test. 


6.  FUTURE  THENDS 

It  It  only  In  the  put  few  years  thit  digital  computers  hive  beeome  available  which  art  euffioiently  fut, 
capacious,  light  end  smell  to  render  feasible  reel-time  on-boerd  solutions  of  problems  the  size  of  that  mechanized 
In  the  C-5  computer.  The  rapid  advance  in  technology  whiah  created  theie  computers  continues:  next-generation 
modsle,  with  vastly  Improved  onpabiUtlaa,  will  soon  be  available.  In  particular,  the  uet  in  such  systems  of 
aslrtnoed,  optimal,  Information  processing  techniques  like  Kalman  filtering,  which  were  hitherto  Ignored  because 
of  their  attendant  memory  end  real-time  coat,  have  now  become  feasible,  Further,  the  superior  performance  avail¬ 
able  in  prentice  from  euch  techniques,  with  reepqct  to  prior  methods,  ensures  their  future  es  the  eventual 
Stamford  tachnlquao  In  suoh  applications.  This  future  will  be  all  thj  more  rapidly  reeUzed,  however,  If  batter 
eolutlone  to  some  of  the  significant  currant  problems  attending  the  aotual  mechanization  of  such  techniques  are 
reached.  With  respect  to  Kalman  filter  mechanizations,  two  prinoipel  current  problems  are; 

(a)  The  Nttd  for  an  Extrtatly  Accurate  Syttan  Description.  A  Kalman  filtar  Bust  incorporate  both  e  model  of 
the  dynuic  behavior  of  the  system  to  which  it  is  applied  end  the  statistics  of  the  nolle  Inputs  forolng  the 
system.  -Meohaniwed  .perfomena*  depends  on  the  fidelity  of  the  aeobaniud  modal  to  the  real  system,  end  on  the 
aoouraoy  with  which  the  assumed  statletloe  characterize  the  aotual  random  input  processes,  Suoh  information 
cannot  in  general  be  easily  or  oheaply  obtained  In  the  oouree  of  a  real  system  development,  where  time  tud  fund* 
are  Halted.  Further  work  on  epproprlat*  modification!  of  the  Kalman  gain  equations,  which  would  provide  a  high 
degree  of  lneenaltivity  to  system  end  input  ala-modeling  or  under-modeling,  is  neceeiery*. 

(b)  Bound-off  Error  Saniitivity.  Th*  standard  recursive  Kalman  formulation  for  detarminlng  optimal  measurement 
weighting  Involves  the  us*  of  essentially  squared,  covariance. matrix  Information.  Round-off  errors  esiooleted 
with  the  fixed  ooaputer  word  length,  whiah  are  introduced  st  eeoh  computational  step,  produce  an  unduly  rapid 
rate  of  weighting  error  build-up,  when  compered  with  whet  could  be  obtained  with  t  formulation  based  on  unequartd 
information,  Although  several  such  formulations  have  recently  been  idvenoed,  more  work  1«  needed  to  establish 
whether  these  do  not  cost  more  in  attendant  speed  end  aemor7  requirements  than  they  gain  in  accuracy  relative 
to  th*  standard  formulation.  < 
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CHAPTER  <4  -  APPLICATION  OP  KALMAN  FILTERING  TECHNIQUES 
TO  THE  APOLLO  PROGRAM 


Richard  H.Battln  end  Herald  U. Levins 


1.  COARTINQ  FLIGHT  NAVIGATION 

Navigating  the  Apollo  ipacecreft  in  coasting  night  involvei  two  proctieoi.  Firet ,  freauan*.  navigation 
measurements  ere  aide  to  improve  the  eetimete  of  the  iimesureft' i  partition  end  velocity.  Rocond,  i  predlotlon 
of 'the  orbit  ie  aide  periodically  eo  tint  email  oorreotione  to  the  apoed  inti  direction  of  aotion  cm  be  applied 
using  the  prupuleion  eyetea  if  the  apeeeonft  ie  not  following  the  Intended  course. 

Predicting  the  course  of  Apollo  during  prolonged  periods  of  cositlni  flight  ie  the  loan  ei  the  astronomer' i 
pro b lee  of  predieting  the  positions  of  the  aeon  end  planets.  There  ere  eiveral  eouaideratloiti  whioh  influence 
the  ability  to  asks  long-range  predictions.  First  of  all  ara  tha  aathaaatloal  tachniquaa  uatd  for  solving  the 
equations  of  notion.  Unless  rethsr  slabcrete  computational  taohnlquie  art  employed,  numerical  error*  will 
propegat*  and  rapidly  dtgrade  the  solution.  Second,  the  aaourtcy  of  pradioting  position  and  veloolty  also  it 
aubjeot  to  our  knowltdg*  of  tba  phyaloal  propartiaa  of  tha  solar  ayeten.  Finally,  abd  neat  important  of  all, 
is  tha  aoourtcy  of  Initial  condition*  -  the  values  of  poiltion  end  velocity  at  tha  tins  from  whioh  tha  pradietlon 
la  nada. 

in  ordar  to  insure  eoourtt*  initial  conditions,  it  is  atoesaary  ptrlodically  to  oorraot  tha  satinets  of 
■paoioraft  poaition  and  valooity  using  data  gathgrad  froa  optioal  or  radar  aaaauraaanta.  Use  of  a  apace  sextent 
allow*  tha  astronaut,  for  example,  to  neteure  tha  apparent  elevation  of  a  star  above  the  earth'*  horleon  or  to 
iseeiUr*  the  angle  subtended  by  the  direction*  to  a  star  and  to  a  landmark  on  tha  noon,  At  the  time  *  meeaureaent 
i*  etde,  the  best  eetlaate  of  the  epaoeoratt'a  position  and  velocity  is  contained  in  the  on-board  digital 
ooeputgr,  Then,  alno*  the  dlreotloni  of  the  ater*  end  the  locations  of  lendmerk*  ere  known,  it  is  possible  to 
oaloulate  the  expected  vein*  of  the  ingle  to  be  measured. 

Men  til*  expiated  vsluy  of  this  measurement  Is  compered  with  tha  value  actually  ntteurad,  tha  difference  can 
be  used  to  correct  the  eetlaate  of  th*  spacecraft's  position  And  veloolty.  A  eeaqenca  of  suoh  measurement! 
separated  in  tias,  together  with  an  soourate  aatheaatioal  description  of  th*  eolsr  system,  will  eventually 
produce  (attests*  with  sufficient  preoleion  to  permit  oorreotiv*  Maneuver*  to  he  aede  with  confidence, 

I, I  Navigation  Instruments 

To  aooonplleh  th*  lunar  landing  objective*  of  the  Apollo  Million,  teo  vehicle*  ere  used  -  the  command  module 
(CM)  tad  th*  lunar  module  (LAI).  Eeoh  vehicle  ie  equipped  with  lentor*  for  enquiring  navigation  meaauraaant 
data,  together  with  a  digital  computer  for  information  processing  and  orbit  predlotlon  (me*  Reference  1).  By 
appropriate  utilisation  of  theme  instrument),  tha  Apollo  astronauts  can  solve  the  three  major  coasting  flight 
navigation  problems  of  th*  lunar  mission:  (1)  olelunar-mldcours*  navigation  of  the  Cll  to  and  from  th*  moon; 

(3)  navigation  of  tba  CM  in  orbit  about  th*  moou:  and  (3)  navigating  both  tha  Ckl  and  Ul  during  tha  rendatvou* 
phase  in  lunar  orbit. 

Reference  orientation  la  maintained  in  both  vehicles  by  manna  of  a  dtvles  oalltd  an  intrtlal  measuring  unit 
(UU),  This  instrument  is  basically  a  snail  platform  supported  and  pivotad  *o  that  th*  epaoaoraft  is  fret  to 
rotate  about  it.  On  this  platform  art  mounted  thrtn  gyroacopat  that  aanma  and  pravant  any  rotation  of  th* 
platfors  from  occurring, 

la  th*  ootaaand  Module  a  rigid  itruotura  mounted  to  th*  apaoaormft,  oalltd  th*  navigation  base,  provide!  a 
ooMMon  Mounting  n'ruotur*  for  a  teleaoopa,  a  aaxtaat  and  th*  baa*  of  th*  IUU  glmbal  ayetem.  Prtoiaion  anil* 
trtnaduoar*  on  r  of  th*  use  of  tho  optical  inatrumenta  and  on  aaoh  of  th*  use  of  tb*  UIU  ginbels  permit 
th*  indicated  angles  to  be  processed  in  the  commend  module  coMputer  (CMC)  to  gitierits  tho  ooaponents  of  th* 
optioal  target*  in  inertial  eyetea  eteble-neeber  coordinntee, 

Th*  eaatent  ((XT),  shown  aohesatlonUy  in  Figure  1,  is  a  38-power,  ntrrow-field-of-view  instrument  having 
two  llnil  of  light,  On*  of  thus  llnee  of  sight  la  fixed  to  the  epeoesraft  and  in  aimed  it  e  landmark  or 
thn  horlMon  by  turning  th*  vehicle  In  epeoo  using  crlentstion  commend*  to  th*  nttitude  control  system.  Th* 
aeaond  lint  of  eight  cin  be  pointed  et  e  star  through  th*  use  of  a  two-axle  hind  control  Ur.  One  ixii  of  this 
aotion.  th*  shaft  axle,  is  parallel  to  th*  landmark  line  of  light,  Th*  shaft  drlvt  change*  the  plen*  in  whioh 
the  navigation  angle  is  seuured  by  pouting  tb*  heed  of  the  inetrument  as  t  whole.  Th*  trunnion  drive  sets 
the  navigation  ingle  by  tilting  th*  trunnion  axle  mirror.  By  superimposing  the  two  Images  in  the  field  of 
view  end  signaling  this  event  to  th*  ooaputer  by  deprefiing  e  mark  button,  tli<i  navigator  oan  measure  the  angle 
between  tb*  line*  of  sight  to  *  itar  and  sithar  a  landmark  or  th*  horizon. 
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Tilt  loinnlng  telescope  (SCT),  shown  la  Figure  2,  In  a  unlty-puwar,  wide-fiold-of-vlew  instrument  having  a 
•  ini  1*  Lin*  of  light,  Both  «h*ft  nm!  trunnion  control  of  this  Uni  of  light  li  possible,  The  ihitt  ingl*  1* 
mads  always  to  follow  the  asxtant  shaft  angle,  while  the  trunnion  can  lie  idccted  eo  that  the  astronaut  may 
look  either  along  the  atar  or  landmark  lino  of  eight  of  tho  sextant.  The  wide  field  of  view  alda  considerably 
In  etar  and  landmark  recognition. 

A  very  high  frequency  (VHP)  link  between  the  two  vehicles  exiata  which  la  normally  used  for  Intar-vshtolo 
volo*  communication,  However,  a  algnal  path  through  this  VHP  link  from  the  CM  to  tha  LM  and  back  to  the  CM 
makes  potalbla  a  tnoneuremont  of  the  range  between  the  vehlclen.  Data  from  tills  automatic  VHP  range-link  la 
ueod  In  the  CMC  during  rendezvous  navigation  to  complement  tho  manually  aoqulrcd  optical  measurements, 

Optloal  navigation  sightings  are  not  required  in  the  lunar  module.  Howover,  to  aid  In  a  successful  rendez¬ 
vous  with  the  command  module,  a  rendezvous  radar  (HR),  shown  In  Figure  3.  la  provided  and  mounted  near  the  LM 
inertial  measuring  unit  eo  that  dlrectlun  data  can  be  related  between  the  two.  with  this  inatrumunt  the  range 
and  range  rate  of  tho  CM  with  rnapecL  to  the  U1  as  well  an  the  direction,  in  terms  of  shaft  and  trunnion  angles 
of  the  redar  antenna,  are  made  available  to  the  lunar  modulo  computer  (LMC)  for  state  vector  updating, 

The  command  and  lunar  modulo  computers  are  designed  to  handle  d  relatively  large  and  diverse  sol  of  on-boi.rri 
data  processing  and  control  functions,  Some  of  the  special  requirements  far  tills  computer  Include  (a)  rosi-time 
solution  of  wuvoral  problems  simultaneously  on  a  priority  bgi'.a,  lb)  officiant  two-way  communication  with  tha 
navigator,  <o)  capability  of  ground  control  radio  links,  and  (d)  multiple  signal  intarfaoea  of  both  a  discrete 
and  continuously  variable  typo.  The  memory  notion  has  a  cycle  time  «f  12*isec  and  consists  of  a  fixed  (read 
only)  portion  of  30, 804  worda,  together  with  an  araaable  portion  of  2MB  words.  Each  word  in  mtmary  la  10  bits 
long  (15  data  bits  and  an  odd  parity  bit).  Data  wortls  are  stored  as  signed  14-bit  worda, 

Moat  of  tha  computer  programs  relevant  to  guidance  and  navigation  era  written  in  a  pseudocode  notation  for 
aaanomy  of  storage.  This  notation  la  encoded  and  stored  as  a  list  of  data  worda.  An  “Interpreter"  program 
translates  this  list  Into  a  sequence  of  sub-routine  linkages,  Thus,  the  small  baaio  instruction  sat  la 
•ffaotivily  expanded  Into  a  comprahanalvt  mathematical  language,  which  includes  matrix  and  vaator  operations, 
using  numbers  of  2R  bits  and  sign. 

Tho  display  and  kayboard  (DBKY) ,  illustrated  in  Figure  4,  serves  as  tha  communication  medium  between  th* 
computer  and  tha  navigator.  Tha  prlnoipal  part  of  tha  display  la  a  sat  of  three  registers,  each  containing 
five  decimal  digits,  aa  that  a  word  of  19  bits  can  he  displayed  in  one  register  by  five  octal  digits,  Thraa 
register!  era  uied  beoeuee  of  the  frequent  need  to  display  the  three  components  of  a  vector.  Data  ara  entered 
in  tha  computer  by  tha  astronaut  through  tha  keyboard,  Whon  tha  oomputar  raqulrta  a  response  from  the  estronsut, 
certain  Ughta  ara  caused  to  flash  on  and  off  In  order  to  attract  him  attantlon. 

1.1  Navigation  Data  Processing 

Tha  rtauralva  formulation  of  tha  optimum  linear  estimator,  aa  originally  deviatd  by  R.li. Kalman,  la  Ideally 
aultad  to  tha  spec*  navigation  problem  -  especially  whan  a  vehiole-bome  oomputar  la  utilized  to  proaaaa  data 
obtained  from  on-baerd  Instrumentation.  With  tha  Kalman  estimator,  measurement  data  may  be  Incorporated 
sequentially,  aa  they  are  obtained,  without  recourse  to  the  hatch  prooaaaing  techniques  required  by  other 
methods,  Furthermore,  within  the  framework  of  a  single  computet lonal  aliorithm,  estimates  of  quantities  in 
addition  to  position  snd  volooity,  such  ss  radsr  biases,  mey  be  Included  by  the  simple  expedient  of  Increasing 
the  dimension  of  the  state  vaator.  Finally,  matrix  invtrilon,  with  all  of  Its  numerical  pitfalls,  may  also  be 
avoided  by  regarding  all  measurement  data  aa  alngla-dlmenaional  or  scalar  Information. 

Eaah  computer  In  the  two  vehlolee  maintains  an  estimate  of  the  poiltion  and  velocity  vaotora  of  both  Its  own 
and  tha  other  spacecraft,  These  two  state  vectors  ore  normally  tix-dimeni lonal  but  at  time*  ara  augmanted  by 
certain  parameters  which  must  also  be  estimated  as  part  of  the  navigation  prooata. 

In  olaluhar-mldcouria  navigation  the  commend  module  computer  only  <i  involved  and  the  CM  state  veutor  la  of 
six  dimensions,  However,  when  the  command  module  la  navigating  In  luner  orbit,  It' is  neoassary  also  to  estimate 
the  position  vaator  of  the  particular  landmark  whioh  U  being  traoked.  This  la  conveniently  aooospllahed  by 
utilising  a  nlne-d Inane lonal  otata.  the  first  alx  a  laments  of  whioh  art  the  components  ut  the  CM  position  arid 
velocity  vaotora  in  moon-nentared,  non-rotating  rectangular  coordinataa,  while  the  last  three  elements  are  the 
ooaponenta  of  the  lunar  landmark  position  vaator. 

Two  separata  rendezvous  navigation  programs,  one  in  each  oomputar,  are  used  simultaneously  during  the  rendez¬ 
vous  phue  of  the  mission  with  oaah  solving  th*  navigation  problem  Independently  of  the  other.  In  the  CMC  the 
slx-dlmensional  state  vector  of  either  the  CM  or  the  LM  can  be  updated  from  the  measurement  data  obtained  with 
the  CU  tensors.  Normally,  it  li  the  Ut  state  vector  which  is  altered,  but  the  mode  Is  it  th*  option  of  the 
astronaut*.  Tho  atlsotlon  of  the  updating  mod*  li  baaed  primarily  on  which  vehicle’ a  state  te  more  accurately 
known  initially  and  whlah  vehicle  U  active  In  controlling  the  rendezvous  maneuvers. 

Blnoe  the  rindetvoue  radar  of  tha  LM  la  not  structurally  mounted  with  the  IMU,  elgnif leant  unknown  biases  In 
tha  knowledge  of  tha  direction  of  the  radar  antanna  are  poaalblw,  in  order  to  achieve  the  required  aoouraoy 
during  rendezvous,  it  ie  necessary  to  lnoludo  the  RR  angle  blassa  as  oompuunnte  of  the  state  vector  to  be 
estimated  In  th*  UK.  Although  the  augmented  atate  vector  then  has  tight  component a,  it  la  treated  as  nine- 
dimensional  for  computations!  convenience  with  t.ht  ninth  element  zero, 
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I.  EXTRAPOLATION  OF  THE  STATE  VECTOR  AND  ERROR  TRANSITION  MATRIX 

Th*  intimates  of  position  md  velocity  are  maintained  in  the  epcoeorelt  oonputers  in  non-rotettng  rectangular 
coordinates  end  are  referenced  to  either  the  earth  or  the  noon.  An  carth-eontered  equatorial  coordinate  eysum 
ie  used  than  the  vehicle  Is  outside  of  the  lunar  sphere  of  influence.  Ineide  of  thin  sphere  the  oenter  of 
coordinates  oolnoldes  with  the  oenter  of  the  noon,  The  extrapolation  of  position  and  voloolty  ie  made  by  a 
direct  numerical  integration  of  the  equations  of  notion. 

The  basic  equation  nay  be  written  in  vector  form  as 


d*  fu 

df*  trv  +  vt  «rv  =  »d  ■ 


where  jPV  is  the  vector  position  of  the  vehicle  with  respect  to  the  primary  body  P  ,  which  ie  either  the  earth 
or  noon,  and  nr  Ie  the  gravitational  constant  of  P  .  The  vector  gj  ie  the  vector  acceleration  which  prevents 
the  motion  of  the  vehicle  trim  being  precisely  a  conic  with  P  at  the  focus. 

If  a^  is  small  oomparsd  with  the  central  force  field,  direct  use  of  Equation  (3.1)  la  inefficient,  An  an 
alternativa,  tha  integration  may  ba  accompllahed  by  employing  tha  technique  of  differential  accelerations 
auggosted  by  Knoke  (ate  pages  180-190  of  Rtferanos  3), 

3.1  took*'  a  Method 

At  time  t„  ,  tho  position  and  velocity  vectors  ipv(t0)  and  y,,y(t0)  dsfine  an  oeoulating  conic  orbit. 

The  vector  difference  S( t)  between  the  actual  and  conic  orbits  satisfies  th*  fallowing  differential  aquation: 


rrv(oi  rrv  / 


subject  to  the  Initial  conditions 


i<t,)  a  Q  . 


~I(t0>  =  tf<t4) 


avaluation  of  th*  aoafficiwnt  of  fFV  in  Equation  (2.3)  nay  b*  avoidad.  Sinn# 


It  follow*  that 


£py(t)  *  + 


i  -  =  -  f(,c)  «  1  -  (1  +  Qq) * ^ *  , 


Tho  function  t(q)  may  ba  aonvaniently  evaluated  from 

3  +  3q  +  q* 

f<,>  1  11  r;  (i'vijsw  • 

Incke's  method  may  now  be  luamariicd  at  follows: 


(i)  Position  in  the  osculating  orbit  la  calculated  from 


!>v(0)(t)  =  l_- — Ofa^x1)  Jfylt, 

rpv(V 


)  +  (t-t.)  Sta.x') 


vev(to>' 


and  x  is  dstermlnsd  u  tbs  root  of  Xeplar1  ■  equation  in  the  fora 


v'OVtt-t,)  u 


xaC(#0x8)  +  U  -  ryyftj^x'SfajX1)  +  rFVft0)x 
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Tht  apscUl  trwecendental  function*  s  and  C  are  defined  by 


(a.  e> 


(11)  Deviation*  from  th*  osculating  orbit  art  obteinsd  by  a  nuusrlcal  lntograuon  of 
d*  u 

571  i<t'  =  - -j~n  [f(a,-)i:i.y(t)  +  &a>)  +  ijtt)  ,  (a. in) 

at  pl*V(0  )<c) 

The  flrit  t«ra  on  the  right-hand  side  of  the  last  aquation  must  remln  mmn ) 1 ,  1 , a .  of  th«  inns  order  ke 
gjtt)  ,  If  the  method  le  to  bo  efflolent,  An  the  deviation  vector  5  grown  In  magnitude,  tlile  torn,  will 
eventually  lnoreoee  In  elzo.  Thoreforo,  In  order  tu  mulntnln  the  efficiency,  «  new  oeoulotlna  orbit  should  bo 
doflnud  by  the  true  politico  und  velootty.  Tlio  process  of  selecting  a  new  uonio  orbit  from  which  to  calculate 
devlktlonn  U  oallrd  reotifloatlon.  When  veatiflott.lon  occurs,  the  initial  conditions  of  the  dlffcrahtlal 
equation  for  {.  tra  asnln  aero  and  the  rlglit-hand  aide  1*  limply  the  perturbation  acceleration  at  tha 
tlae  of  reat.floatlon. 

(ill)  The  poeillon  vector  j,,y(t)  is  computed  from  Equation  (3.3)  ualng  Equation  (3,6),  The  velocity  vector 
ifv(t)  is  then  oomputid  ae  , 

iey(t)  a  fey(0)(t)  +  Utt)  ,  (3.11) 

whsre 

Xpv<d><‘>  *  r-rAir - (M  &•*(»,)+  1  C(a,I»)  frytt,)  ,  (3.13) 

rev'to,rev(fl)(t)  L  ri»v(o> 

*.  I  Disturbing  Aeeilirstion 

Ths  fora  of  ths  disturbing  acosleratton  ^  to  be  used  dspende  on  tbs  phase  of  the  mUeion,  lb  earth  or 
lunar  orbit  only  the  gravltatioual  perturbations  arising  from  ths  non-spherlcal  eh opt  of  the  primary  body  P 
used  be  considered,  During  translunsr  and  trunasarth  flight,  tb*  gravitational  attraction  of  thu  aun  and  ths 
ssoondary  body  4  (sithsr  earth  or  moan)  are  relevent  forcee,  A  summary  of  the  verioue  oases  appears  below, 

(1)  Earth  Orbit* 

«f  *  rj;  jjj  (jJ  ■  <*■*»> 

whirs 

Pj(OO«0)  %  3  0010 
Pj(oo»0)  *  j.(15 001*0  - 3) 

Pj(oos0)-  ■  J(7«o»0P'-  -IP') 

Pi(oos0)  =  ^<S non0Pj  -  rPj) 

ars  tht  dsrlvstlvss  of  ths  tisgsndrs  polynooialai 

oce  0  *  iIV  •  i. 

Is  ths  ooslns  of  the  angle  0  between  the  unit  vector  ley  in  the  direction  of  i;,v  and  the  u.ilt  vector  ^ 
in  the  direction  of  the  north  pole;  r(  ie  the  equatorial  radlua  of  the  aarth;  and  J|(  ,  J,g  ,  1„,  are  tha 
ooefflalenta  of  tha  iscond,  third  and  fourth  hamonlos  of  the  earth1 1  potential  function,  The  subscript  R 
deootaa  the  oenter  of  the  aarth  as  tha  origin  pf  ooordlnitea. 

(11)  Traaalunar  and  Tranauarth  night** 

It  *  [*<d4)l,,  *  £yV]  -  Q  [f(qg)i;M  +  tyy]  .  (3.  14)  ♦ 

rqv  rav 

where  the  eubeorlpte  4  and  S  denote  the  eeoondary  body  and  the  eun,  rsepeotlvely,  Thue,  tor  example,  pf , 
la  the  poeitlon  vector  of  the  eun  with  respect  to  the  primary  body,  The  arguawnte  q()  are  culouleted  from 

*  gee  page  IPS  of  Wetereuce  3. 

"  lee  pay*  13  of  Reference  3. 

1  During  the  ptrlode  of  Iranswartb  and  tnueluuar  fllsht  whwo  thi  (iklole  Is  near  the  prlmsi’v  body,  the  Uuturblna  aooelera- 
tin  ebloh  u  used  le  tbe  sum  at  Bquatloo  (3,M)  and  cither  (3.1b)  or  (3,17),  shlohsvsr  Is  appropriate. 
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(CfV  •  Emv 

q{  j  .  - - 


r?(> 


and  the  function  f  from  Equation  (2,3), 

In  tha  vicinity  of  tha  lunar  aphera  of  influence  a  change  in  origin  of  coordinatea  la  nude.  Thus 

Epy(t)  -  rp,(t)  s  isv(t>  -  EPy(t)  ' 

ipvU)  -  Vpq(t)  =  vay^t>  -  fpy(t) 

(ill)  Lunar  Orbit* 

*d  «  jf  fe  tp;*, <toa*> imV  -  Pktcoa^g  *  3.»„M ('M  [<  * 

rHV  \  "m  V  /  \rUV/  [  XMV  +  yMV 

+  Xy -~  -"v  ((5cob30  -3)iyV  -  2oos  i/'ij) 

*«v  "*  ^av 


(2.15) 


(2. 1C) 


(2. 11) 


there  r„  is  the  naan  lunar  radius;  xMV  and  yMy  are  the  lunar  equatorial  plane  conponents  of  lav  '•  lnd 
J,,„  la  that  coefficient  of  the  noon’s  potential  function  associated  with  the  auynnetry  of  the  noon  about  its 
polar  axis. 


2.3  Error  Transition  Matrix 


Thu  position  and  velocity  vectors,  aa  nalntained  in  the  computer,  are  only  estimates  of  the  true  values. 

As  part  of  the  Hainan  eatlmr.tiun  technique,  it  la  also  necessary  to  rtnord  etstistloal  d.tta  for  the  processing 
of  navigation  nsasureeents, 


If  <(t)  and  r/(t)  arc  the  erroru  in  the  eatiaatea  of  the  position  and  velooity  vectcra,  resoeotively, 
then  the  alx-dunouslonsl  covarlanoe  matrix  E,,(t)  is  defined  by** 


Iea<« 


t(t)t(t)T  ftttytTN 

ij(t)£(t)T  2<t)2(t)'  / 


(2.18) 


Aa  noted  In  Section  1,  for  cartain  applications  It  la  necessary  to  sxpand  th*  atats  vector  and  the  covariance 
satrn  to  sore  than  six  dimensions,  In  erdsr  to  include  the  estimation  of  landuark  locations  In  the  CMC  during 
orbital  navigation  and  tbs  rendezvous  radar  trsoking  biases  in  the  LMC  for  rendezvous  navigation.  For  this 
purpose  a  nine-dimensional  covariance  matrix  Is  defined  ts  fellows; 


Eft) 


«<«F\ 

T  / 


(2.18) 


when  the  oomponentn  of  the  three-dimensional  vector  £  are  the  eatlmatiun  errors  of  the  three  additional 
variables  to  ba  ostlmatad. 

To  taka  full  advantage  of  the  operations  provided  by  tha  lutorprater  In  thv  apaouoraft  computers,  the 
oovarianoe  matrix  la  raatrioted  to  either  air  or  niue  dimensions.  In  tha  LMC  rendezvous  navigation  procedure, 
only  two  additional  quantities  are  estimated,  Howover,  a  dummy  variable  la  added  to  the  state  vector  to  make 
it  nine -dimensional. 

Tha  appropriate  relation  to  be  used  is  extrapolating  tha  E^ft)  matrix  la  obtained  u  follows.  The  braio 
equation  of  motion  of  the  vehicle  with  respect  to  the  primary  body  say  be  written  in  the  form: 

A*»  Mo  Me 

Ov  +  rr  lev  +  rr  fciv  f  rr  tea  i:  I  • 

ai  r,y  r,v  r>4 

where  the  veotor  g  enoompasiea  the  gravitational  acceleration  of  the  urn  aa  wall  aa  tba  other  disturbances 

arising  froa  the  asymmetrical  ahapea  of  tha  earth  and  moon.  This  aquation  con  be  linearized  about  the  beat 
aatlaate  of  tha  vthloU'a  state  and,  to  a  first  order  of  approaiaatlou,  tha  estimate  error  veotors  will 
satisfy  the  retulting  linear  differential  equation,  he  have 


d /iuA  _  I'i  A/tuA 

dt\2<t)/  '  \^g(t)  S/\2<t)/‘ 

where  l  and  0  are  the  threB-dlmonelonul  Jdent ity  and  zero  matrices,  respectively, 

The  satHx  Q(t)  la  tha  three-dimensional  (radiant  of  the  iravltatlonal  field  with  reaped  to  tlio  component* 
of  tha  poaltlon  vector  rpy  .  If  we  neglect  the  grediont  of  tha  vector  (  ,  ‘hen  It  la  easy  to  ahow  that* 

j<t)  =  -£!— •  [3£PV(t)rpw<t)T  -  r*v(t)ll  +  [3c4v(l)t(,v(t)T  -  r'(t>l)  ,  (2. .70) 

rpv(t)  rqy(t) 


which  la  i\  eufflolontly  good  approximation  for  tranalunar  and  tranaearth  flight.  For  orbital  navigation  about 
the  primary  body  only  the  flret  term  expre.oion  for  g<t >  need  bo  included. 


8ino'  -  ...  .  fctt)''  ^(t)T) 

S“(t)  ’W 

It  le  eaay  to  chew  that  the  elx-dlmenalonal  covariance  matrix  eatiaflon  the  following  matrix  differential 
equation: 


Because  of  accumulated  numerical  lnaccuraoiea,  It  la  poaalblt  that  tha  covarianoa  matrix  may  fall  to  remain 
poaitlve  definite  after  a  large  number  of  oooputatlone,  aa  It  theoretically  muat.  An  innovation  to  avoid  thlo 
problem,  which  hea  alac  the  advantage  of  algnlfloantly  reducing  certain  computational  raquiromenta,  la  to  rtplaoe 
tha  covariance  matrix  by  a  matrix  fl(t)  ,  called  the  error  transition  matrix.  The  J(t)  matrix  haa  the  property: 

*<t>  a-»(t)W(t)T  (3. 21) 

and  thue,  in  a  aenae,  la  the  aquara  root  of  tha  coyarlance  matrix.  If  needed,  tha  covarianoa  matrix  may  be 
determined  aa  the  product  of  the  matrix  *(t)  and  ltd  tranepoeo,  thereby  guaranteeing  it  to  be  at  leaat  poaitlve 
eeal -definite. 


The  chief  computational  advantage  of  the  W  matrix  Ilea  in  tha  almpliolty  of  the  differential  equation  which 
it  amtlaflea.  From  the  diffarentlal  equation  for  E(<  ,  the  faot  that  the  oomponenta  of  the  vector  ^  do  not 
change  alth  time,  and  Equation  (2.31),  it  la  obvious  that 

d  /«  1  fi\ 

-  w  *  (o(t)  o  o)|. 

\s  2  a/ 

Now  let  the  nine-dlmenitonvl  matrix  W(t)  be  partitioned  ae 


(2.23) 


Then,  ee  neve 


_d 

dt 

■d 

dt 


s,  \ 

I  * 

(  S.  lit 

...  tu  ]. 

(3. 33) 

\Ht.  Hi. 

•••  hi/ 
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1 

dl*‘(t)  1 

slt,(t) 

:  Wfc>  s 

a<t)s4(t> 

►  i  *  0,1... 

.,  ,  8  . 

(2.24) 

*1+ l  = 

2 

Thua,  the  extrapolation  of  the  W  aitrix  any  be  accompliehed  by  aucoeeiively  integrating  the  veotor  differential 
equatloni  . 


dt* 


It(t)  =  g(t)ij(t)  1  a  0,1, 


(2. 29) 


Finally,  then,  if  D  la  the  dlaeaalon  of  the  matrix  l[(t)  ,  tha  different lal  equationa  for  the  *4(t)  vactora 
are  simply 

Sill  =  {»[W*>  MlttS  izv(t>  *Si<t)}+  j3LiqW(i)-!i(t)]l,v(t)  -*i(t)|  (2.28) 

i  =  0,1 . D-l 


with  tha  atcond  t«ru  onitttd  for  orbital  navigation  about  the  primary  body  P  , 


'  ¥9 


get  page  207  of  Reference  7. 


2.4  Numeric*!  Integration 
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Tba  extrapolation  of  tho  ntata  viator  and  thn  error  transition  ruitrlx  requires  tho  solution  of  f)  +  1  aeoond- 
order  vector  differential  aquations,  sctclflcally  Equntlone  (2.10)  and  (2,28),  Those  are  ell  apenlal  onset  uf 
the  fora 

d* 

=  f(jl.t)  ,  (3.27) 

in  which  the  rlght-hend  side  is  s  function  of  the  Independent  varlahte  and  time  only.  Mystrdm's  method,  described 
in  Reference  3,  is  particularly  well-euitad  to  this  form  and  given  on  integration  method  of  fourth-order  accuracy, 
ehlle  requiring  only  three  computations  of  the  derivatives  per  time  step,  (The  uauul  fourth-order  Runge-Kuttn 
Integration  methode  require  four  derivative  computations  per  time  atep, )  The  second-order  system  Is  written  as 

d 

dt*  =  6 


dt  *  "  ^1>J 

and  the  formulae  are  aumuar lzed  as  follows: 

*♦1  -  in+H *n>At 

hu  =  *n  +  l£<in>At 

*  ?n  +  Hki  *  *k|)At 
'k(ta)  *  Mi  +  kka+kj) 

Hi  * 

+  iSnAt+  .  t„+{At) 

It)  =  i<h  +  *nAt  +  fka  tet)* .  + 

ror  efficient  use  of  computer  storig*  ee  well  ae  computing  time,  the  computation!  ehould  be  .performed  In  the 
following  order: 

(i)  Equation  (2.10)  Is  solved  using  ths  Nystrflm  formulas  (2,28).  It  la  necessary  to  preserve  the  values  of 
the  veotors  £rv  at  tinea  t„  and  t„  +  At/3  for  usa  in  the  solution  of  Equations  (2.28), 

(li)  Equations  (2.28)  are  aolvtd  on*  st  t  time  using  formulas  (2.29),  togsthsr  with  ths  vsluss  of  rrv  which 
rsaultsd  from  ths  first  step. 

It  hag  been  found  experimentally  that  the  maximum  value  that  the  integration  tine  step  At  can  have  is  either 
0,3(r}v4ur),/>  or  4000  seconds,  whichever  is  the  imaller. 


>  • 


(2.29) 


3.  INCORPORATION  OF  MEASUREMENT  DATA 

An  important  feature  of  the  Apollo  navigation  method  is  that  meeauressnt  data  from  a  wide  variety  of  source! 
may  be  incorporated  within  the  eemo  framework  of  computation.  Associated  with  each  measurement  le  a  D-dimensional 
victor  1)  representing,  to  a  first  order  of  approx  last  ion,  the  variation  in  the  measured  quantity  Q  which  would 
raault  from  variations  in  the  components  of  ths  state  vector,  Thus,  each  measurement  establishes  t  component  of 
the  spacecraft  state  vector  along  ths  direction  uf  ths  b  vector  in  state  ipaci. 

By  algebraically  combining  the  J  matrix,  the  h  vector  and  a  mean-squtred  a  priori  estimation  error  <x9  in 
the  measurement,  there  are  produced  a  weighting  veotor  a  and  the  step  change  to  be  made  in  the  error  transition 
Matrix  to  refleot  the  ohangei  in  the  uncertainties  in  the  estimated  quantities  ea  s  result  of  the  measurement. 

The  wslrhtlng  vector  cj  has  D  components  and  is  determined  so  that  the  observation  data  la  utilized  in  a 
statistically  optimum  manner. 

According  to  the  Kalman  estimation  theory  for  a  one-dlminelonel  scalar  measurement,  the  weighting  veotor  is 
determined  froe 

Hi  =  l-  Sfi  .  <3-l» 

share  f  le  the  value  of  the  covarlano*  matrix  extrapolated  to  the  time  of  the  measurement  end 

a  =  tl’gij  +  c?  .  (3.2) 
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For  eonvonlenoe,  define  the  victor  b  m 


(3.3) 


■  =  Irh  . 

so  that  Equations  (3.1)  end  (3.3)  aw  be  written 

1. 

a  ‘  — !J  (3.4) 

»  *  ■'«+?.  (3. 8) 

Then,  If  5q  represents  th*  dlffer«noo  between  the  quantity  actually  neaaured  and  lte  sxpnoted  value  baaed  on 
the  extrapolated  value  of  the  ttate  vector,  the  chanie  in  the  atate  vector  la  simply  o£q  , 


At  a  result  of  the  ms&iiureaent,  the  atetlattca  embodied  in  the  covariance  matrix  E  or  lte  square  root  * 
muat  be  altered.  Again,  tba  Kalmnn  theory  diotataa  that  thn  new  value  for  g  ,  denoted  by  E*  ,  ij  obtained 
from 

r  ■ 

or,  In  term*  of  the  t  matrix  and  the  z  vector, 

s*  *•  s(i " ;  mt)st  .  (•••) 

where  X  la  the  D-dlmenslonsl  Identity  matrix. 

What  la  dealred,  of  ocuraa,  la  a  formula  fm  updating  the  I  matrix  rather  than  the  g  matrix.  The  objec¬ 
tive  till  be  achieved  if  a  square  root  a an  be  found  for  the  parenthesised  factor  in  Equation  (3.8).  Indeed, 
the  desired  result  is  obtained  by  determining  the  value  of  the  paramater  V  such  that 

By  straightforward  computation  it  le  seen  that  y 

v 

so  that  the  new  value  1*  le  computed  ee 

f* 


.2*)’ 


suet  be 


"  1  +  /(S’/a)  ‘ 


(3. 7) 


w  I  - 7WjT  . 


(3.8) 


In  order  to  take  full  advantage  of  the  thrae-dimeoslonil.  vector  and  matrix  operations  provided  by  the  Inter¬ 
preter  in  the  oomputer,  thn  nine-dimensional  |  matrix  le  stored  sequentially  as  follows: 


w*^  w^ 
a  ’  wi  1 


Then,  by  defining  the  three-dimensional  eub-smtrioeu 
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end  partitioning  the  possibly  Dlne-dlmenelonal  veotore  b  ,  »  ,  and  a  ss 
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the  computations  developed  in  this  section  are  conveniently  performed  ee 


(3.9) 


<3. 10) 
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1  til 

«J  *  ;  J5  *u.j  s  *i+.j  ■ 

whar#  tht  subscripts  1  and  J  range,  raspecttvely,  from  0  to  D  -  l  and  from  0  to  (D/3)  -  1  . 

It  la  worth  emphasizing  that  the  particular  formulation  of  the  Kalman  estimator,  developed  In  thin  end  the 
prevloue  aectlon,  hoe  achieved  what  la  felt  to  be  a  minimum  In  practical  computational  efficiency  ea  well  u  a 
meet  aparina  une  of  eraaable  memory  locations  In  the  amall  volilcle-borne  Apollo  computera,  Tim  latter  la 
poaalbla  primarily  becauao  of  the  Introduction  of  the  error  transition  matrix  instead  of  the  more  convontional 
cuvarlanoe  matrix, 

It  should  bo  remarked,  however,  that  straiihtforward  application  of  the  I  matrix  techniques  would  not  have 
been  possible  had  the  dynamics  of  the  state  vector  aodel  included  what  la  commonly  called  "process  noise", 

■inoa  we  have  elected  to  neglect  proceaa  noise  in  favor  of  computational  compactness,  the  gradual  and  Inevitable 

deoay  of  the  elements  of  the  1  matrix  must  be  countered  In  practice  by  a  ptriodio  re-initialization  of  those 

elements,  It  should  be  dear  that,  without  either  including  process  nolss  or  re-inltlallmlng  tho  g  matrix, 
eventually  all  measurement  data  would  be  ignored  simply  because  they  would  be  given  a  aero  weighting  factor. 

4.  COMMAND  MODULE  C1ILUNAR  -  MIDCOURSE  NAVIGATION 

During  the  translunar  and  transaarth  phases  of  the  Apollo  mission,  navigation  data  can  be  obtained  with  the 

sextant  by  measuring  the  angle  between  the  lines  of  sight  to  a  star  and  an  earth  or  moon  horizon  or  landmark, 

then  the  .navigator  depresses  the  mark  button,  Indicating  to  the  computer  that  the  two  targot  optical  images  are 

properly  superimposed  in  the  SXT  field  of  view,  the  time  of  the  measurement  and  tha  measured  angle,  l.a.  the  fiXT 

trunnion  angle  A,  are  automatically  recorded  In  the  CMC,  The  navigator  must  than  inform  the  oonputer,  through 
the  DBKY,  of  the  Identity  of  the  etar  and  tha  particular  faatura  of  tha  earth  or  moon  involvad  in  tha  sighting. 
Theee  data  art  used  by  tha  computar  to determine!  (I)  the  CM  itate  vector  estimate  and  lta  aaaoolated  error 
transition  matrix  axtrapolated  to  tha  maaauramant  time,  aa  described  in  Section  3;  (11)  tha  aatlmatad  CM  position 
vector  cv  relative  to  that  body  used  in  tha  maaauramant  (einoe  thle  may  ba  either  tha  primary  body  P  or  tha 
secondary  body  0,  tha  ilugie  subscript  will  serve  without  ambiguity);  (ill)  tht  unit  vector  1,  In  the  direction 
of  the  particular  star  used  {there  are  data  far  31  stars  In  tht  CMC  (lead  memory  which  the  navigator  oan  identify 
by  eoda  number);  and  (lv)  tha  position  vaotor  ^  of  the  landmark,  assuming  a  star-landmark  measurement . 

4. 1  Rtar-Landeark  Measurements 

geoause  of  the  extresMly  high  auourecy  required  for  aldcourse  navigation  meamuremanta,  observation  data  suet 
be  aorreoted  for  eberretlon  prior  to  proaeiilng,  Aberration  la  tha  tarn  used  to  describe  the  chanae  in  tha 
apparent  direction  of  an  object  due  to  tha  velocity  of  the  obaervar  normal  to  the  line  of  sight  to  the  object. 

Tt  is  only  when  this  perpendicular  velocity  has  a  magnitude  of  tan*  of  thousands  of  fast  per  second  that  tho 
aberration  correction  ie  necessary,  It  should  b*  remarked  that  tha  correction  is  not  required  for  rendezvous 
or  orbit  navigation. 

The  apparent  dlraotlon  of  tha  star  is  computed  from 


ij  ■  Onlt^i,  +  fef-tAsy 


where  the  notation  Unit  (9)  la  understood  to  atan  a  unit  vector  in  the  direction  of  the  veotor  9  .  The  vector 
III  1*  the  velocity  of  the  earth  relative  to  tha  sun,  and  0  is  tha  ipiad  of  light.  The  velocity  of  the  sun 
relative  to  the  star  1*  already  taken  into  account  for  tha  basic  star  directional  data  J,  ,  and  th*  relative 
velocity  between  the  eertb  and  aeon  ia  negligible  for  the  oase  in  wbioh  tho  soon  it  the  prissry  body.  The 
expeoted  direction  of  the  landmark  la  obtained  from 

i*l  *  Unit  ^ivl  +  (4.3) 

where  iVL  »  Uolt/r^  -rv) 

is  a  unit  veotor  defining  the  estlaated  direction  of  the  landmark  relative  to  the  vebiele. 

Using  the  corrected  unit  vectors  corresponding  to  the  directions  of  the  two  SXT  lines  of  sight,  th*  CMC 
eoaputea  the  meuured  deviation  &H  u 
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Although  for  clalunar-midoourae  navigation  the  CM  etate  Victor  it  alx-dlmonnionai,  only  th*  first  three 
ooaponanta  of  the  Measurement  geometry  vector  b  ,  defined  in  Section  3.  will  bo  nonzero,  iinde  the  netniirtd 
Quantity  is  independent  of  velocity  exoept  through  the  email  aberration  correction.  To  doteraine  thin  non-zero 
partition  b0  of  the  b  vector,  we  coaputn  the  firet-order  differential  of  the  erpreaelon 


rvt.  ooe  A  s  l*.r*L  , 


with  the  reault  that 


ooeA  Sr}L  -  rJL»lnA  8A  =  Al’sI*t.  ' 


Then,  aince 


_  i*l  1  sr*h 


and  Sty, 


Vt, 


Si, 


PV 


we  have 

Hence 


ryUeinA  SA 


=  (jJ  -coa  A  A*t,)  .  Sp|,v 


jS-^dT-coaAiV 


or 


h.  ■ 


uait  ti!  -  u;  •  i*o 

rVL 


(4.4) 


Finally,  the  aauureaent  error  variance  le  computed  froa 


*  a  <ri  +  :V 


(4.8) 


where  crj  and  o-J  are  the  aaeiueed  error  varianoee  In  the  SXT  trunnion  angle  and  the  landmark,  reepeotlvely. 


4.1  Itar-Horlaon  heaaurenente 


■Hit  prooeeeing  of 'iter -horizon  .aeaauriaent  data  la  the, ease  an  that  reQUlred  for  etar-landnark  data,  provided 
the  landmark  location  vector  ^  le  replaced  by  a  vector  froa  the  epaoeoraft  to  the  horieon.  The  determination 
of  thle  horieon  vector  le  made  according  to  the  following  gaoaatrical  argument!, 


Conilder  firet  en  earth-horizon  aeaaureaent.  The  atar  direction  A*  and  the  eetiaated  CM  poeitlon  vector 
Ey  deteralne  a  plena.  Assuming  that  the  horizon  le  at  a  constant  altitude  eoove  the  earth1  a  surface,  the  inter¬ 
section  of  thia  aeeiureaent  plane  vith  the  horizon  le  approximately  an  elllpee.  The  orientation  of  this  horizon 
elllpze  lz  defined  in  tern*  of  three  autuelly  orthozonal  unit  veotore: 


i. 


Dolt  (i,  »  £y) 


in  *  Unit  (jy,*  A,) 


ii  *  i.  *  le 


(4.8) 


where  Aa  1*  a  unit  vector  in  the  direction  of  the  earth' e  polar  axis.  Referring  to  Figure  7,  it  it  dear  that 
A,  and  Ai  oolnclda  with  the  seal-major  and  aeai-alnor  axes  of  the  horieon  ellipse,  reepeotlvely,  The  plane 


containing  the  horizon  illipae  is  Inclined  with  reapeot  to  the  earth' z  zquatorial  plane  by  en  angle  I  ,  where 


ainl 


it  •  A| 


(4.7) 


The  zhape  of  the  horieon  elllpze  la  determined  by  the  length*  of  lti  major  and  Minor  axes.  Aaaualng  the 
oontour  of  the  earth  to  b«  will-approximated  by  th*  eo-oalled  Fiaoher  ellipeoid.  the  aeai-aajor  axis  of  tha 
horizon  elllpze  1*  eiaply  the  am  et  the  seal-major  axle  of  this  ellipeoid  end  th*  oonetant  horizon  altitude. 
Likewise,  th*  eenl-alnor  axis  bH  la  found  by  adding  the  horizon  altitude  to  that  value  of  th*  radius  of  th* 
Fleoher  ellipsoid  which  correspond!  to  a  latitude  equal  to  til*  Inclination  angle  I  . 


The  problen  of  deteralnlng  the  vector  cL 
and  y  axes  oolnold*  with  th*  dlreotlon* 


1*  readily  solved  in  th*  horizon  coordinate  zyztea  for  which  th* 


■lo 


rezpectlvely,  zz  llluetrated  In  Figure  8.  Th*  aitrlx 


(4.8) 


*111  serve  to  transtora  vectors  froa  th*  original  coordinate  eyetsa  to  th*  horizon  syetea. 
represent  th*  components  of  ry  end  A*  In  horizon  ooordlnatee,  ao  that 


Let 


£h 


end 


340 


fh\ 

CH  ■-  )  =  Mlv 

w 


a.h  -  m.  *  J 

Further,  define  {0  and  J,  an  vectors  t rox  tha  point  <xH,yH>  to  tha  two  points  of  ttngeney  with  the  horlton 
all ipse. 

Tha  vectors  and  1,  era  obtained  by  solving  slaultanaoualy  the  aquation  of  tha  boriaon  ellipse! 

*'  y* 

3*3  *  ‘ 

and  the  aquation  of  the  linn  tangent  to  tho  ellipse  and  passing  throdlh  tha  point  (.i^.y,,): 

«H  .  "a  , 

?  ^  ' 


il  B  J  *hV((1-» 


1  «  0,1, 


.1  .» 

•h  bH 

•Thwupparand  lower  aims  ill 'equation  <4  .TO)  correspond,  respectively,  with  i  =  0  and  i  =  1  , 

Tha  two  points  of  tuigency,  pg  and  ,  correspond  to  tha  two  horlson  points,  r£H  (near  horizon)  and 
{£h  (far  horlson),  but  not  necessarily  respect lvsly.  By  definition,  the  near  horizon  la  aasooiatad  with  that 
viator  £i  whlah  aekee  tha  saaller  ansle  with  the  star  veotor.  Ihs  nor lain  veotor  la  then 

Ip  *  .  <«•“> 

using  for  t  slther  fcj  or  ,  whichever  Is  epproprlste, 

In  the  CHO,  ■oon-horlaon  aesjursaents  are  procured  under  the  are  caption  that  tha  soon  hu  a  sphsrlcal  shape. 
The  detsrailnetloa  of  the  horlson  vector  cL  la  aada  u  for  tha  earth-horizon  case  but  with  the  aoan  radius  of 
the  noon  used  for  both  e„  end  bH  . 

B.  COMMAND  MODULE  NAVIflATION  DURING  RENDIZVOUI 

To  aooomllih  rendssvoua  with  the  CM  and  Ut  in  the  Apollo  niselon,  two  typee  of  navlgetlon  date  ere  obtained 
eltb  the  CM-based  senior*.  Aa  described  In  Beotian  1,  these  data  art  acquired  both  aanually  with  the  optics  ahu 
autoaatloally  through  the  VHP  range-link.  They  serve  in  conpllsentary  roles  for  rtndsavoua  navigation.  The 
optical  data  ylalda  io forest Ion  in  the  directions  noratl  to  the  CW-to-LM  line  of  sight,  whereas  ths  VHP  range- 
link  gives  information  along  the  line  of  eight.  Taken  tngethsr,  they  provide  an  erne Heat  rendeavous  navigatiou 
capability. 

It  ia  recognised  that  tba  optima  atthod  of  epplyl.il  the  Xslaen  eatiaatton  tachnlque  to  rendezvous  navigation 
would  ba  to  aolva  tho  twelve-diaenslunal  problev  of  alauUsutdua  sit  last  ion  of  both  the  CM  end  LM  etataa. 

However,  the  Ualtatloua  of  a  relatively  eaell  erasable  resory  preolnde  the  storage  of  the  required  twelve- 
diaenalonal  error  transition  aatrlx.  In  the  CMC  rendezvous  navlgetlon  procedure  (and  in  tha  LMC  aa  well),  the 
eetisated  state  viator  of  ons  rohlelt  only  is  nltered  by  tbs  nevig*tion  date,  Conssqusntly,  the  error  transi¬ 
tion  aatrlx  is  of  aanageable  elz-dlaenalonal  else  and  ia  extrspolated  with  shiohever  state  veotor  is  being 
eat  lasted. 

Bee eme  of  this  ilaplitlcatlon,  together  with  soee  other  rslatsd  factors,  the  error  transition  matrix  dose 
not  aalntaln  an  aonurato  rapruantation  of  ths  oovariintu  of  tha  raiatlva  atate  srrors  bstwesn  the  two  vehicles. 
This  situation  neoeeaitates  a  ra-lnitlalizatlon  of  ths  nitrix  at  various  tins*  during  the  rendezvous,  osssntlsliy 
to  restart  tfc  •  solution  in  both  the  CMC  und  LMC. 
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S.l  Optical  Measurements 

*  Approximately  once  par  minute  during  ths  navigation  portion!  of  tha  rendezvous  phase,  the  Apollo  navigator 
sight!  tha  LM  ueinj  tho  ritloul*  pattarn  in  ths  SXT  atar  lino  of  eight.  Whan  tha  nark  button  in  depressed,  tha 
time  of  tha  measurement,  tha  SXT  shaft  and  trunnion  angles,  and  tha  thraa  IMU  sltnbal  anglaa,  which  deacrlb* 
tha  orlantation  of  the  navigation  bato  with  raapact  to  tha  inartially  stabilized  platform  are  all  automatically 
raoorded  in  tha  CMC. 

from  thane  five  angles  and  tha  known  orientation  of  the  inertial  platform,  tha  measured  direction,  j,  ,  of 
the  IM  as  observed  from  tha  CM  is  obtained,  It  is  convenient  to  consider  the  unit  vaotor  J,  as  having  baan 
found  by  the  simultaneous  measurement  of  the  angles  between  the  llnei  of  eight  to  the  LM  and  two  ntarn.  Tha 
data  art  procaeaed  by  (electing  two  convenient  unit  vectors  (fictitious  atar  directions),  converting  the  vaotor 
to  an  equivalent  set  of  two  artificial  star-LM  measurements,  and  using  the  measurement  incorporation  pro¬ 
cedure  of  Seatlon  3  twloe  -  once  for  each  artificial  measurement.  These  two  unit  veotore  ore  chosen  suoh  that 
they  and  tha  eitlraatad  lint  of  eight  veotor  form  in  orthogonal  triad. 

Tha  processing  of  each  of  the  two  artificial  measurements  is  similar  to  the  olelunar-mldoouree  navigation 
procedure  described  in  ejection  4.  Let  rfa  and  rrL  bo  the  CM  and  LM  position  veotore,  respootlvoly,  extra¬ 
polated  to  the  time  of  tha  measurement.  "  ' 

for  convanianoe,  tha  first  flotltioua  star  diriotion  is  ohoaan  to  be 

i4l  =  Unit  [(j01l  *  *  lj  ,  <»•») 

ehers 

lgl  «  Unit  (lyp-Ipo) 

is  tha  eatimatad  CM-to-Ui  line  of  sight.  The  measured  deviation  ia  than  ilvas  by 

5Q  -  ooa'1  0,,  .  (V3> 

ainoa  j,,  and  ljL  art  parpendiaular.  This  orthogonality  also  permits  a  simplification  in  tha  calculation  of 
the  geometry  veotor  tig  •  Indeed,  from  Equation  (4.4),  we  have 


*•  ’  *;r> 


The  plue  or  elnua  Sign  la  aeleated,  respeotivaly,  aooording  as  tha  CM  or  LM  state  veotor  ie  to  be  updated. 

fallowing  the  alteration  of  ths  appropriate  state  veotor,  tha  second  artificial  measurement  la  incorporated 
by  recomputing  the  veotor  icL  and  aeleating  the  flotltioua  star,  direction  as 

l,,  =  Unit  (i,!*  J01,)  .  (*.*) 

The  meaaurenent  error  variance  a7  for  each  incorporation  is  a  constant  whioh  is  tha  sun  of  ths  assumed  error 
varlannea  of  the  SXT  and  knowledge  of  the  IMU  orientation. 

5.1  VHF  gangs  Link  Measurements 

Asynchronous  with  the  mutually •acquired  optical  data,  and  at  spproximataly  tha  noma  frequency,  VHF  range 
measurements  ore  automatically  tokan.  Again,  the  time  of  the  meuuramant  and  tho  measured  CM-to-LM  range  R 
are  reaordsd  in  the  CMC, 

The  measured  deviation  for  this  range  asaaurement  li  limply 

SR  =  R  -  reL  .  (#•#) 

To  determine  ths  geoeatry  veotor  b0  ,  ee  ooapute  the  first-order  differential  of 

R*  r  “Eso^  •  i£st  “Ere* 

under  the  aasiiaption  that  it  in  tha  CM  slate  veotor  whioh  is  to  bt  cwtimated.  There  results 

■  Rf*  =  -  •  8j>o 

■  5*  =  “  lot  •  *£rc  • 

<kt  the  otn.r  hand,  if  the  LM  state  veotor  1*  to  be  updated,  the  relationship  would  be 
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whir*  th*  upper  or  lower  sin  depend*,  respectively,  on  whether  th*  CM  or  LM  atet*  vootor  1*  to  bi  changed, 


«.  LUNAR  MODULE  NAVIGATION  DIRINU  RENDEZVOUI 

Mill*  tho  CMC  ii  actively  inquiring  ind  processing  dill  during  thi  renduvous  phsm  of  Apollo,  tho  lint 
mvlgitlon  problti  In  btlng  einultinoously  ind  independently  tolvid  in  th«  LMC,  mint  trioklflg  inforostlon 
githirid  froo  thi  rindiivous  ridir  nountid  on  th«  LM  vshiole.  Aftsr  RR  tricking  loquliltton  of  the  CM  li 
•itibllihid,  the  LMC  rioordi,  it  ipproilmtciy  one  BlnuU  Intervals,  the  neanurid  rings  R  ind  rings  rite  It  of 
the  CM  elth  reipeot  to  the  LM,  together  with  the  iheft  ingle  /I  ind  the  trunnion  ingle  0  of  the  glmbelled 
ridir  d iih .  In  iddltion  to  them  four  netiured  qusntltlei,  the  tiM  of  tho  ooisurioent  ind  the  three  IMU 
glibil  inglee  ire  ilio  noted. 

Ae  deiorlbed  in  Section  1,  eight  virliblee  ire  eetlonted  u  pirt  of  the  mvlgitlon  prooedurs.  Ttiu  uiutl 
three  aoiponenti  of  the  poiltlon  end  veloolty  veatore,  rfv  ind  vfv  ,  of  thi  iileoted  ipnaeorift,  LM  or  CM, 
with  reipeot  to  the  primery  body  P  ,  conetltute  the  flrit  six  ooipontnte  of  the  etite  viator.  The  eetlnete* 
of  the  bluen.  6/3  ind  8 6  ,  in  the  RR  ihitt  end  trunnion  engine  ire  the  eiventh  end  eighth  ilemnti.  A 
dbwy  virlible  1»  ueed  for  the  ninth  coiponent  to  fuiliteti  three -diieniiooil  vector  operetlone, 

The  Mwured  quentltiei  produoe  four  itquentigl  elteretiane  of  the  nine-dlieenilonil  etite  vector  throuih  four 
■eperite  ippllaetloni  of  the  Hiuurnint  inoarporitlon  Method  deiorlbed  in  Reotlon  3,  The  inoorporitlon  !■ ,  of 
oouree,  ptrfoned  reourelvely,  i.e,  it  iioh  itige  the  me  saMponinte  of  thi  iteti  viator,  resulting  froi  thi 
prevlouA' updsti,  ire  und  In  ooaputing  the  nut  updete  in  the  eequenoe.  The  usiuriunt  error  virlinoee  a1 
ere  bund  on  n  priori  knowledge  of  the  rider  perforguae, 


8.1  Ringe  end  Ringe-ttate  Neuureeienti 


The  aeiiured  devlition  In  ringe  ind  th*  associated  eeiiuriiut  geoaitry  viator  p0  iri  th*  urn  i*  for  thi 
VHP  Muuriient  of  ringa  In  thi  CM  end  and  not  be  further  dieouiiid.  For  thi  ringi-riti  dlti,  tblusiured 
deviation  li  sully  min  to  b*  '  '^‘W. 


iq  «  R  *  <Vgc“2pi,>  ‘  itd  ‘ 


(8.1) 


Th*  geoMtry  vector  h  for  the  rings -re te  eeuurenent  provldii  thi  flrit  cue  moountirid  thui  fir  for  whloh 
both  the  Jj,  ind  b  pirtltlom  iri  dlffiront  fro*  giro.  To  ditinlm  th*  b  vector,  w*  oonput*  th*  firit- 
order  differentlil  of  th*  relition 

v 

■  .  <Iio_£et)  •  (feo'Xiu^ 

■jith  th*  i*(uiptloi(  that  It  1*  the  CM  *t*t*  vector  which  li  to  be  eitluted.  Re  uive 

~  <Xlo  1  Sleo4,  Cic 1  *W  “  IT"  (ite  '  Slo^Elc  *  ®Ivo 

*L0  rLO 


_>  Ilo  x  '  ®Ifo  +  ~  ito '  ®Iee  • 

"to  ruo 

To  obtiln  th*  proper  rilitlonahip  if  th*  LM  etite  vector  ii  to  be  eitluted,  w*  need  only  not*  thit  8jfl  *  Srpo  . 
Thug,  th*  non-iero  pirtltlom  of  th*  £  vector  ire 

S<  *  *  7“  Ilo  *  Qtio  " 

■  10  (8.3) 

Si  =  *  ilO 

*•»  ' 

with  the  ohoio*  in  ilgn  dependent  on  the  pirtloulir  etite  vector  to  be  updited  (plug  for  CM  ind  ilnug  for  LM). 


Ik 


or,  aHirnatlvilfjf 


til 


l.t  Udir  Antenm  Angle  Meuureamt* 

Th*  rendeavou*  ridir  intenn*  dieh  li  it  tb*  origin  of  tb*  RR  csrtialia  ooordlniti  lyetia,  u  men  in  Plguri  9. 
Shift  action  tiku  plioi  about  th*  poiltlv*  -y  uls  and  thi  ehift  ugli  P  li  neuurid  froi  th*  poeitive  i 
uii,  Trunnion  notion  occur*  In  i  plim  norul  to  the  u  plan*  end  contelning  the  iheft  axle  y  .  Thi  oon- 
flguntlon  li  such  that  th*  trunnion  uli  would  coincide  elth  tho  x  ule  for  giro  ittift  ingle  with  the  trunnion 
angle  8  ,  under  those  oirouutincei,  neaeured  fron  the  i  ule, 

Let  1,  ,  L  .  i,  ba  unit  vector*  ilong  th*  RR  oocrdlnit*  ue*.  By  seine  of  th*  recorded  IMU  global  engine, 
together  vltn  the  knowledge  of  the  Uertlil  orientation  of  tbi  IMU,  the  oonponente  of  i,  ,  iy  ,  1,  ere  readily 


obtained  In  buio  rtfereno*  coordinatan,  It  In  uaiy  to  verify  with  reference  to  the  fiiure  that  the  nurtured 
deviation  Tor  the  ihaft  main  in 


JQ  8  /3  -  tan*1  4  5/3.  , 
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while  that  for  tha  trunnion  anslo  la 


a  <?  -  r Rin*1  +  50] 


Thi  poattlon  veotor  of  th*  OM  with  r*ip«iit  to  th*  LM  ii  expreieible  in  tern*  of  component!  *loni  th*  RR 
coord  in*t«  iwt  u 
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To  obtain  the  mown1  *ment  geometry  veotor  corresponding  to  th*  »h»ft  angle,  we  ***ln  oomput*  the  differential 
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Mailirly,  for  th*  trunnion  end*,  «•  hev* 
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Th*  quantity  rLC  oo* 8  ,  ahloh  »pp**r*  in  th*  npriaoiong  for  5/3  tnd  59  ,  1*  duply  th*  length  of  th* 
promotion  of  tn*  rLC  veotor  in  the  x*  plan*.  By  dinoting  thi*  length  by  r„  ,  *•  Ray  oaloulat*  lta 
value  fron 
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and.  for  th*  trunnion  angl*  victor, 
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where  th*  plua  or  llnui  dgn,.  u  b*for*,  ludlott**  dtber  th*  CM  or  LM  »t*t»  viotor  ia  to  b*  updated. 

Sinoa  th*  antenna  anglta  *r«  indtptndint  of  viloclty,  w*  oonolude  that  fc;  =  0  for  both.  Howtvtr.  baoauaa 
w*  are  alao  intimating  th*  angl*  bit***,  th*  b,  partition*  of  th*  ^  vtotora  art  not  z*ro.  Ind«*d,  for  the 
ehait  angl*, 
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and,  tor  the  trunnion  enfle, 
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TH«  estimation  of  the  radar  blues  is  included  regardloee  cf  whathor  it  it  tho  CM  or  Ut  atate  vector  which 
ii  biim  uatlmattd,  Sines  the  rider  bias**  do  not  dopond  on  whioh  vehicle' i  state  veotor  comprises  the  tint 
■ix  coaponente  of  the  utimetid  etete,  there  ic  no  eliii  nicotian  eeeoolited  with  these  li,  part  it  ioim . 

7.  COMMAND  MODULO  ORBIT  NAVIGATION 

When  the  Apollo  speoeorift  is  in  either  eerth  or  lumr  orbit,  mvliition  diti  oen  he  obtained  by  optical 
Mteuresents  of  the  lines  of  stiht  to  landmarks,  Theeo  plenotiry  eurfies  feeturee  oen  be  either  of  the  "known" 
or  "unknown"  virioty.  A  known  landmark  le  in  Identifiable  feature  whose  ooordlnates  ire  known  ind  tibulutud, 

In  oontrut,  m  unknown  landmark  le  any  surfaoa  feature  which  tho  iitromut  say  sclent  end  optlcully  track  in 
the  brief  period  durlns  whioh  it  is  visible.  The  mechanics  of  the  measuring  process  is  quite  similar  to  the 
CM-to-UI  line  of  sight  measurement  procedure  described  in  Section  5. 

7,1  Known  Landmark  Measurements 

As  indicated  in  Section  1,  orbit  navliation  Involves  a  nlnc-dlmeniilonal  state  vector,  the  last  three  com¬ 
ponents  of  which  are  the  ooordluaten  of  the  landmark.  Since  the  tracking  period  for  one  landmark  in  very  short 
(lees  than  one  minute  in  the  case  of  the  earth  and  only  two  or  three  minutes  durliiR  lunar  orbit),  all  navliation 
data  for  any  particular  landmark  are  acquired  before  the  processing  basins.  At  the  conclusion  of  the  tracking, 
the  lendmerk  partition  or  the  etate  vector  le  initialized  from  the  identifioetion  dnte  entered  by  tho  navigator 
Into  the  computer. 

Sufficient  CMC  erasable  storage  le  allocated  fur  fiva  measurements  on  a  single  landmark.  Tho  data  from  gaoh 
of  those  sighting*  consist*  of  tht  tin*  of  the  measurement  and  th*  set  of  anglas  described  in  Section  8.  Prom 
the**  ugiai  the  mtuurT  unit  vector  A,  along  th*  CM-to-landmark  lln*  of  sight  is  aomputtd. 

Er.  h  of  th*  measured  unit  vectors  la  converted  to  an  equivalent  eet  of  two  artificial  star-landmark  moevire- 
men'  in.  exactly  th*  same  manner  as  in  tin  rtndaavou*  navigation  procedure  discussed  in  Section  8.  the  only 
difference  is  that  th*  geometry  vector  is  nlno-dimenelonal  and  is  given  by 


fc  ■  r-  J  ,  (7.1) 
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where  rVL  is  the  current  estimated  dietinos  between  the  vehicle  and  tha  landmark,  and  A,  denote*  the  direc¬ 
tion  to  tha  artificial  stars. 

7,1  UiluMin  Landmark  Naasursmants 

Th#  ning-dimanslonal  orbit  navigation  ttchniqua  providu  a  means  of  mapping  on  the  gurfact  of  s  planot  a 
point  whioh  la  daalgnatad  only  by  •  number  of  sat*  of  optical  tracking  data.  This  prooeea  may  be  usad  aither 
to  looat*  a  dgslred  U4  landing  sits  which  may  havs  unknown  ooordinttaa  or  to  map  futures  on  th*  surfaoe  of  th* 
moon. 

Aasum*  that  a  landmark  han  bean  traokad  and  N  sets  of  optical  navigation  data  havs  been  acquired,  If  the 
navi tat or  cannot  -  or  ohooses  not  to  -  identify  the  landmark,  it  ia  than  treated  a a  an  unknown  landmark.  In 
this  process  th*  data  from  th*  first  navigation  maaiurament  art  usad  to  oomputa  an  Initial  estimate  of  the  land¬ 
mark  location.  The  nine-dimension  state  veotor  le  then  formed,  and  th*  data  from  th*  ramalning  N  -1  lighting* 
ara  iuoorporattd  axaotly  as  if  th*  optioally-daeignatad  point  had  been  an  identlfltd  landmark. 

The  determination  of  th*  initial  eitlmst*  of  th*  landmark  position  vactor  £,_■  la  accomplished  as  follows. 

Let  Am  ha  the  measured  unit  veotor  from  th*  vehicle  to  the  landmark  calculated  from  th*  data  of  the  first 
measurement.  Then 

El  *  lev  +  rvtim  >  <7'a> 

with  rv(l  obtained  by  applying  th*  law  of  ooelnai  to  tha  triangle  defined  by  Equetlou  (7.3).  v«  then  have 

r!t  -  <Jr,v  °°»  VrVL  +  (rwV-f)  ■  <T-*> 

there  tf  le  tbe  redlna  of  the  primary  body,  and  A,  is  th*  angle  between  the  direotioni  from  the  vehicle  to 

th*  oenter  of  th*  primary  body  and  th*  landmark  and  Is  aomputtd  from 

ooiAi,  *  -  1,  .  Unit  (r^v)  . 

Rolving  Equation  (7.3)  and  aalaotlng  th*  appropriate  sign  yields 
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Thun,  tht  Initial  aatlaated  looation  of  thi  unknown  landmark  1*  ut»  >li«hed.  Th«  retaining  N  -1  i*te  of 
data  art  thin  und  u  for  i  known  lindnirk,  Moordlng  to  Section  7,1. 


7.3  Inltialliatlon  of  th*  Error  Trwnittlon  Matrix 

Beveral  different  landmark*  ere  tricked  by  the  Apollo  navigator  'o  navigutn  in  omit  about  the  earth  or  noon. 
As  a  consequence,  spiolal  method*  are  required  to  reinitialise  the  >  rror  tranaltlon  matrix  each  time  a  new 
landmark  la  acquired,  This  la  necoaeary  to  rofleot  the  fact  that  the  Initial  landmek  looation  errora  are  net 
correlated  with  th*  error*  in  the  eitlmateri  CM  poeitlon  and  velocity  vect^s.  therefore,  before  pruceaaina  the 
aeaaureaent  data  associated  with  a  new  landmark,  it  la  ncceeaary  to  convart.  the  nlne-dlmeneloml  error  tranaition 
matrix  g  to  a  eix-dimenelonal  matrix  havtui  the  eame  CM  poaition  'ind  velocity  error  varlancei  and  covarlancee. 

A  maw  nine -dlnenelonal  matrix  it  then  formed  by  augment  ini  appropriate  landmark  uno<-rtainty  intcrmatlon, 


Aa  tha  first  it an  in  the  initialisation  proceaa  it  la  neoaaaary  to  determine  a  equare  root  of  the  eix- 
dlmsnelonal  partition  £(|  of  the  nlncdlmanslonal  covariance  mat:  lx  £  ,  define*  in  Equation  (2.10).  From 
Equatlona  (2.21)  and  (3.9),  it  la  olaar  that 
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the  equare  root  of  (M 


l.s.,  a  six-distnsional  matrix  >«  auoh  that 

Sulli  B  In  1 


(7.8) 
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it  not  uniqusi  Howavar.  a  convenient  method,  which  ie  umed  in  th*  CMCi  ie  to  meleot  a  triangular  form  for  g(l  , 
ao  that  tho  raiulting  get  of  algebraio  equation*  for  th*  element*  of  !*.  ie  moet  eailly  eolved. 


The  eeoond  part  of  the  g  matrix  initialisation  depends  on  whither  the  landmark  being  tracked  ie  known  or 


unknown,  For  a  knowu  landiark,  th*  new  nlne-dlMiniional 

h  matrix  la  fersed  asi 
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with  th*  upper  left-hand  six  by  alx  partition  balm  th*  equarm  root  setrix  found  in  part  on*.  Thm  three- 
dimenelonal  eub-mntrlx  I,  ie  given  a  valua  oonaiatent  with  th*  expected  error*  in  the  knowledge  of  th*  land- 
nsrk  looation.  In  particular ,  g,  is  ohoasn  so  that 

gjj,  -  <»■•> 

whara  i  is.  tha  vaotor  error  in  the  landnark  poaition. 

If,  on  the  other  hand,  tha  aiuuriaeuti  are  made  mini  an  unknown  landmark,  tha  error  in  the  initially  computed 
■stlsate  of  the  looation  of  tha  landmark  will  ba  a  function  of  tha  unoertalntlei  in  the  CM  poeitlon  eetluate,  the 
tracking  aoouraoy  end  the  altitude  of  the  landsark  above  the  gravitational  center  (eee  Reference  4).  In  thia 
oeae,  part  two  for  tha  initialisation  of  the  g  matrix  ia  more  complicated. 


The  basic  relationship  among  tha  quant it  lee  of  intireit  la  Equation  (7.3).  Error*  in  £pv  and  ,  denoted 
respectively  by  t  and  5^  ,  will  produce  an  error  in  the  landiark  looation  n,  •  Howavar,  tbls  arror  la 
olau ly  in  th*  plana  of  tha  landmark,  1.*.,  perpendicular  to  ^  ,  Alio,  an  arror  in  rVL  will  result  In  a 
landmark  position  arror  In  th*  dlreotlon  of  and  of  a  sagnituds  irLv/(rJct)/]^rL  •  *herg  5rL  is  tha  error 

in  th*  landmark  altitude.  Thua,  th*  total  error  £  in  th*  landmark  looation. ia  gives  by 


share 
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(7.10) 


is  the  projection  operator  ehlob  asauraa  that  only  tba  oomponant*  of  j,  and  5^  in  the  plan*  norsai  to 
are  related  to  th*  landiark  location  error. 


Now,  oonslder  a  coordinate  eyetea  ln  which  th*  direction  1,  ie  alons  cn*  of  th*  coordinate  axis.  Than,  if 
J  U  the  transformation  aatrix  which  relates  th*  eelected  axle  myatea  and  tha  orlsinal  reference  lyetem,  **  have 


Tht  error  in  1,  nay  lit  oxpreeoed  u: 


/ a  co»  X' 
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wharf  oi  is  thi  mill  random  anile  botween  the  true  and  moaaured  diroottona  to  the  landmark.  Tim  polar  angle  X 
If  defined  In  the  plane  normal  to  i,  from  the  aoardinatf  axle  to  the  pro.leotion  of  the  maasurad  direction  of  J^, 

Aaaume  that  a  and  X  are  atatlatioally  Independent  random  variable*  with  xara  mnene,  Further,  aseumo  that 
X  la  uniformly  dletributed  over  the  Interval  -if  to  »i  .  Then,  for  the  oovarlanoe  matrix  of  tho  uncertainty  In 
^  ,  we  obtain 
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where  o ■*  ie  the  variance  of  «  . 


Plaally,  eince  g  and  the  veloolty  errot  rj  are  atatlatlcolly  Independent  Of  51*  »nd  6rt  ,  we  may 
oeloulete  tho  followlni  oovarlanoo  matrloee  from  aquation  <7,8>t 


fl?  ■  ififTaf+  W^iKi-iwiJ^1*^  U 


As  1  rwault,  the  W  aatrlx  If  lnltlallfid  as 
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whfr*  J  4  nee  A.itermlnad  aa  tha  thraa-dlmnnalonal  triangular  square  root  of 
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Aftar  Incorporating  the  data  obtained  from  Uiu  tracking  of  a  landaark,  all  SI  alamanta  of  the  W  matrix  will 
again.  In  general,  be  non-xero,  Indicating  oorralationa  among  all  component a  of  vahlola  position  and  velocity  end 
Uadatrk  poeltion.  This  metrlx  ia  axtrapolated,  aa  deicribad  lu  Beotiou  3,  until  a  new  landmark  la  aonuired 
oecasa lifting  a  naw  initlallmatlon. 


■  .  FLIGHT  KXmiENCB  OF  THI  APOLLO  NAVIGATION  SY8TIN 

Tht  first  manned  trip  to  tha  violnlty  of  tha  aoon  of  Apollo  B  during  Deoimber  1BS0  gava  an  axoallant  teat  of 
tha  Apollo  ayatea'a  on-board  navigation  capability  (ate  Referanoe  B>,  Although  ground  tracking  navigation  warn 
tha  priaery  eyataa,  tha  on-board  navlgotlon'syetew  had  tha  teak  of  confirming  ■  safe  trajectory  and  provldln*  a 
bsok-up  for  raturn  to  aarth  in  tha  raaota  china*  that  ground  aaalitinc*  btoiaa  unavallabla  for  on-board  uaa, 

Apollo  t  waa  to  u»«  aun  llluainatgd  vlaual  horlaona  rather  than  landmarks  for  oparatlonal  simplicity,  avan 
though,  aa  oonf lraed  froa  earth  orbit  by  Aftrunaut  Don  Ilaelt  in  Apollo  T,  the  earth’  a  horizon  dots  not  provide  * 
dlatlaot  target  tor  vlaual  uaa.  Uoreovar,  tha  illtar  in  tha  asxtant  beamsplitter,  daelgned  originally  to  enhanoe 
tha  oontraat  batwaan  water  and  land  whan  louklng  down  at  the  earth,  filters  out  the  blue  in  aucb  a  way  a*  to  make 
tha  horiaoa  even  aor*  indiitlnot.  Originally  a  blue  aenaitiva  photoeater  had  been  designed  for  horizon  detection 
ia  the  prototype  eextaut  nodeU,  but  waa  rtaoyvd  from  the  production  ayateae,  since  a  deolalon  bad  bean  aade 
that  ground  tracking  would  ba  thr  prtmry  source  of  aidoourii  navigation.  Without  the  photometer,  interest  in 
the  aarth’ a  horiion  a*  a  visual  target  resulted  in  damonatratloue  on  simulators  that,  in  some  subjective  way,  the 
busan  with  a  little  axparli.ioe  can  cliooee  an  altitude  sufficiently  repeatable,  at  laast  as  good  as  ±9  kilometers. 
Aooordingly,  a  fat  weeks  before  tha  Apollo  W  launch,  tha  naviaator  ooanand  modulo  pilot,  Jim  Lovell,  apent  a  few 
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hour*  on  tho  sextant  tenth  horUon  simulator  at  the  Massachusetts  Institute  of  Technology  In  Cambridge  for 
treliiimt  and  to  calibrate  tho  hoiir.on  altltudo  he  eeeniod  tu  prefer,  llo  wan  remarkably  consistent  In  choosing 
a  .ocatlon  23,8  kilometers  above  the  aoa  level  horinon.  Thi»  value  wan  recorded  In  the  CMC?  is  part  of  the 
pre-launch  oiaavon  load. 

The  plan  fur  the  slue  ion  »»»  to  examine  the  aextant  angle  measurements  made  early  while  at  111  near  tho  earth 
and.  baaed  on  th*  apacocraft  etute  vootor  determined  by  ground  trucking.  Inter  »n  real-time  the  liorlaon  altltudo 
Lovell  war  using,  After  tho  flrat  s'ovon  sighting*  on  the  oarth  ot.  dtatoncim  of  about  30  thousand  nautical  miles 
from  earth,  It  was  setlmatud  that  ho  was  using  on  18.3  kilometer!  ultltudu  and  the  CMC  was  relouded  with  this 
new  value,  (Later  during  the  mission  It  was  agreed  that  a  truer  netlmnte  wsu  nearer  S3  kilometers,  but  the 
vkIuo  was  not  changed  since  the  dlflere.ioe  then  wss  too  smalt  tu  bo  of  oonorrn.)  Following  the  horlson  osllhre- 
tlon,  the  first  midoourse  correction  if  almost  2B  ft/sno  was  performed.  Tho  lari)  else  of  thin  correction  wss 
due  to  trajectory  porturUtlons,  resulting  from  the  maneuvers  performed  In  getting  the  spuoeoruft  .lafely  away 
from  the  third  stage  of  the  launch  vehicle. 

After  tho  mldoouvso  correction,  the  CMC  state  vector  wus  made  to  agree  with  the  value  obtained  from  '[round 
tracking.  Hie  Important  parameter,  predicted  perilunu  altltudo,  was  lit).  7  nautical  miles  -  vory  olouo  to  tbs 
true  value  estimated  later  to  bo  68.  8.  The  next  31  navigation  measurements  worn  made  using  the  earth's  bur  Iron, 
modeled  at  18.3  kilometers  altitude,  Doing  sufficiently  for  from  both  oarth  and  moan  during  Ibis  time,  It  Is 
not  surprising  that  tho  Initially  goud  state  vector  was  degrnded,  At  the  end  of  this  period,  the  indicated 
psrlluns  was  33  nautical  miles  below  ths  noun's  stiffen* .  With  the  next  nine  sightings,  still  UHlng  the  earth's 
horlson,  the  predicted  perllune  Increased  to  93. S  nautical  miles  ••  ehout  22  nautical  miles  too  high,  The  exact 
altitude  of  tha  earth's  horlson  was  unimportant  for  these  sight  Inge  since  the  distance  from  earth  wae  now 
approximately  ISO,  POO  nautical  miles,  so  that  the  10  aro-eeound  accuracy  of  tha  sextant  was  the  predominant 
scuroa  of  arror. 

Tha  next  group  of  IS  lightings  eaa  made  using  ths  moon  horiecn  at  a  distance  of  ebout  DO, 000  nautloal  miles, 

As  would  he  expected,  the  first  tew  of  these  reeultad  Ip  fairly  lsrge  change*  in  the  estimated  etete  vector, 
while  the  remaining  had  a  vary  email  affaot.  At  tha  and  of  thil  group  cf  measurement.!,  the  Indicated  perllune 
wae  ST.l  nautloal  miles,  Thu  final  sat  of  18  traselunar  sightings  was  midu  about  38.000  nautloal  miles  from 
the  moon  with  little  additional  effect  on  the  perllune  intimation.  Tha  final  estimate  woe  07. b  nautloal  miles 
or  about  1.3  nautloal  ullae  lower  than  the  value  later  rooanstruotid  from  ground  tricking  date,  At  this  time 
the  on-board  and  ground  traoking  data  wart  practically  Identical  and  ooneldtrntion  was  given  to  using  the 
on-board  state  vector  for  lunar  orbit  insertion,  Although  the  etate  vaotor  update  hardly  changed  the  on-board 
value,  It  was  performed  elnoe  there  tan  no  overriding  argument  to  deviate  from  the  flight  plan. 

The  trsnesarth  flight  of  Apollo  A  after  v0  lunar  orbits  alio  provided  e  good  measure  of  the  on-board  navigation 
capability,  Thu  transeurth  Injection  eaneuver  of  the  aervioe  propulsion  eyatem  was  tsrgetted  by  ground  data  and 
executed  In  book  of  tha  soon  by  the  on-board  digital  autopilot  and  guidance  uystens.  This  3822,8  ft/ceo  maneuver 
wee  followed  by  t  single  mldooura*  correction  of  4.8  ft/eeo  14, T  hours  liter,  resulting  in  entry  conditions  at 
400,000  feet  altitude  abevo  the  earth  whloh  wars  0.8  ft/ieo  fester  end  0,1°  shallower  then  planned. 

Although  thu  primary  navigation  during  this  period  wae  again  tha  ground  traoking  network,  138  on-board  naviga¬ 
tion  measurements  wars  perform'd  by  Lovell  ns  a  monitor  and  baok-up.  In  order  t.o  determine  what  would  have 
happened  without  ground  assistance,  the  eotual  on-board  measurements  were  incorporated  in  a  simulation  with  the 
ooagmtar  Initialised  to  the  eotual  on-board  atatw  vector  aa  it  ex la ted  when  the  upeoeoraft  coursed  from  behind 
tha  noon.  The  single  transearth  mldoouree  correction  was  added  appropriately  tu  this  simulation,  In  aouordanos 
with  that  actually  maaaured  by  tho  Inertial  guidance  eystiin,  (In  the  actual  flight  a  new  ground  determined  ittit* 
vaotor  was  loaded  Into  th»  computer  at  the  tin*  of  this  maneuver.) 

The  last  of  the  138  measuremrnte  was  aomplsted  18  houre  be fora  entry.  The  incorporation  of  those  maasuruments 
la  the  simulation  left  e  hypothetical  on-oosrd  aatimata  of  entry  flight  path  angle  at  400,000  fast  of  -0.30°,  as 
compared  with  thu  ground  tracking  eatimats  of  -8.48°,  This  0.1s  dlffurenoa  was  well  within  the  unfa  tnlsriuioe 
of  ±0, 8°.  Another  parameter  of  oonoern  at  the  entry  Interf aoe  Is  the  error  in  knowledge  of  altitude  rat*.  The 
elsu la ted  on-board  estimate  of  this  quantity  differed  from  that  estimated  by  ground  tracking  by  230  ft/eeo, 
Homsvsr,  the  oonatrvetlvg  allowable  tolerance  is  i200  rt/iwo, 

It  should  ba  ampliaaleed  that,  In  the  event  ground  data  were  not  available,  the  plan  wae  to  continue  the  on¬ 
board  measurement!  to  optimise  tha  final  mldoouree  correction  end  state  vootor  for  inf*  earth  atmospheric  entry. 

In  the  tbaenue  of  actual  flight  data,  a  continuation  of  the  elr.ulatlon  using  the  planned  sighting  program  was 
■ads  with  standard  davlation  error*  In  tha  sextant  of  ID  aro-eeuonda  and  in  the  horlson  of  3  kilometers.  In 
addition,  bias  errors  of  8  ara-aeoondt  In  the  sextant  and  4  kilometers  in  the  Iturlson  were  Included,  Thu  result¬ 
ing  eitlmatlon  error  in  tha  entry  tng'.e  at  tha  entry  Interface  had  a  standard  deviation  of  U.03u  and  >  bias  of 
0.007°.  The  corresponding  altitude  rat*  uncertainty  hud  e  etendard  deviation  of  41.1  ft/sea  end  t  bias  of 
30.8  ft/**c.  The  capability  of  the  on-board  navigation  eyatem  to  bring  the  epaoecruft.  safely  back  from  the  moon 
seems  clearly  to  have  been  demonetrated. 
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P<t)  a  F<t)P(t)  '  P(t)Pr(t)  +  0!t)m)0t(t)  , 


P(t>  a  l[x(t)-J<t)][x<t)-£<t)]t 

a  covariance  of  irror  in  estimate  8(t) 

F(t i  a  system  matrix  In  Ititl  equation 
*(t)  ■  atat*  vaotor,  g ivan  by  x(t)  a  P(t>z(t>  +  0(t)»ft) 
£(t>  »  Kalaau  tutor  aatlaata  of  x<t) 
r<t)8(t)  a  *[*(t)-*{t)](w(t)-»(t)]T 

w(t)  a  wbita-aola*  driving  itata  aquation 
*(t>  «  Ew(t)  a  o 
S (t)  a  oirao  dolt*  function  or  t 
fl(t)  a  input  aatrlx  for  aft) 
l<  )  a  aipaotatice  of  (  ) 

(  )*  ■  tranapoaa  of  (  ) 


ao  that,  for  tha  aovarlanoa  aatrU  Pj  aftar  Incorporation  of  data  at  tlaa  t(  , 
Pj  a  P l  -PJ  HjtHjPjHj  *•  Rj]  1  HjPj  . 
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CHAPTER  IS  -  SOME  APPLICATIONS  OP  KALMAN  FILTER  1  NO  IN  SPACE  GUIDANCE 

J.P,  Bollantonl 


1.  INTRODUCTION 

Aaons  tha  flrat  application*  of  linear  optlaal  rncuraiv*  filtarlni  vara  thoaa  mad*  by  Battin1  ami  by  MoLaon, 

Btoil bh ,  Bohmidt  and  MoOa*,|>,  to  tha  estimation  of  tha  position  and  velocity  of  a  spuneoreft.  The  field  of 
■apace 'navigation  still  provldaa  a  fruitful  area  of  application  of  title  technique,  two  of  the  applications 
dasoribad  in  this  olmptar  deal  directly  with  apace  navigation:  tha  error  annlyala  of  a  satellite  navigation 
system,  and  unidentified  landmark  navigation.  Tha  third  application  deals  with  initial  alignment  of  an  inertial 
guldanoa  systas  that  will  indicata  vahicla  position  and  valodity  during  bcoit  into  a  fraa-fall  trajectory, 

t.  ERROR  ANALVS1I  OP  A  SATELLITE  NAVIOATION  SYSTEM 
], I  The  Kalman  Plltsr  as  •  Tool  in  Error  Analysis 

ana  of  tha  useful  properties  of  tha  linear  recursive  optlaal  filter  (Kilwui  filter)  It  that  It  generates  ite 
own  error  analysis  in  tha  prooaaa  of  aatlaatiog  tha  state,  In  faot,  tha  aovarlanoa  matrix  Pft)  at  arror  in 
tha  tatinaiia  (ft)  .  upon  which  tha  error  analysis  reete,  may  be  eonputed  reourelvaly  ov*r  the  time  of  interest 
without  benefit  of  real  date,  Thli  in  of  importance  in  the  preliminary  design  itageu  of  aircraft  end  epaoeoreft 
guldanoa  systems,  since  a  prediction  at  eyatem  performanoa  nay  ha  made  knowing  only  tha  atat lit ioa  of  tha  Instru¬ 
ment  errorn  and  tha  times  of  tha  observations,  Tha  biala  equations  era  that,  for  the  proposition  of  the  oovtrltnoe 
matrix  between  measurement  tinea, 
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Hj  *  obeurvatlon  eatrlx  »t  tin  ti 


tj  ,  tj  ■  t inf t  Juit  before  and  juft  after  obatrvetlon  at  tt 


An  alternate  forn  of  Equation  (1.1), 
approximated,  ia 


P(tj)  « 


ueeful  when  the  etate  transition  matrix  ^(tj,tj.,) 


it  known  or  nay  be 
(1,1)' 


where 


Ktj.t,.,) 


f  ^(t1,T)Q(r)r(r)aT(T)0t(t1,T)  d t 


(1.3) 


If  approxlaetione,  adequate  for  the  purpoeee  of  error  analyele,  are  available  for  i>  and  q  ,  then  Equation 
(1,1)'  in  euperior  to  Equation  (3.1)  in  ttut  it  avoltle  the  inteiration  iwiplioit  in  Equation  (1.1). 

The  aeeumpt lone  underlying  thie  type  of  error  analyele  lepoaa  lialtatlone  that  nay  preclude  lte  uae  In  wont 
appliuationa.  The  aajor  eaeunptlone  are: 

(1)  The  etate  vector  x(t)  ie  adequately  described  by  a  linear  differential  equation  driven  by  white-noleei 

*(t)  «  E(t)x(t)  +  0<t)w(t)  ,  (2.4) 

where  P(t)  and  O(t)  are  known. 

(1)  The  obeervatlona  K>(t1)  are  linearly  related  to  the  etate  x(tt)  by 

Ettj)  -  Hft^Kt,)  +  Vitj)  ,  <2,0 

where  HdpfwHj)  la  known  and  v(t1)  It  white-nolee. 

(3)  The  naan  and  variance  of  w(t)  and  v(t)  are  known, 

(4)  The  elniauM  variance  linear  filter  fij  in  uaed  to  lnprove  the  etate  eatlnate,  ea  followe: 

*<t{)  -  i(tj)  +  -M1t(tt>]  ,  (3.3) 

The  lent  aeeunptlon  (4)  le  not  eaeentlal.  If  the  filter  le  linear,  but  not  neotaetrlly  nlninun  variance, 
Equation  (3.3)  My  be  replaced  by  the  wore  iwneral  expreeelon 

Pj  «  (I -KjHpPj  (I-EjHj)*  +  EjRjKf  .  <31. 7) 

where  Ej  ,  a  iwneral  linear  filter,  hu  been  uetd  in  Equation  (2.3)  lneteed  of  .  A  eiaple  derivation  of 
Equation  (2.7)  la  elven  In  Appendix  A.  It  le  eaey  to  ehow  that  Equation  (2.7)  reduoet  to  Equation  (2.2)  when 
kf  ■  ,  where 

'  8j  ■  +  l4t]-‘  ,  ,  (2,3) 

Equation  (2.7)  ie  of  uae  in  analyeini  the  error  of  t  linear,  eub-optlnal  filter,  In  particular,  the  aub- 
opt Inal  filter  beini  anelyeed  nay  be  a  Kalann  filter  baaed  on  (1)  an  approxleate  xtate  traneitian  eatrlx,  or 

(2)  a  etate  oontalnlne  only  eoee  of  the  varlahlee  of  the  problen,  cr  (3)  etwee  approx iaat ion  in  the  filter 
deelined  to  eava  computation  tine  or  ipaoe, 

The  oholoe  of  etate  veotor,  and  the  oholne  of  wodele  for  the  vurleblee  oontelned  therein,  determine  the  etate* 
trannltion  matrix.  db  end  the  nolaa  oovarianoa  0  in  Equation  (2,1)',  .For  error  analyele  purpoeee  It  le  often 
pocalble  to  Mke  enough  approx iaat lone  in  the  error  nodela  to  allot  uae  of  the  mteireted  fore  Equation  (2, 1)’ 
rather  then  Equation  (2.1).  The  inteirated  fore  will  be  uewd  txoluaivtly  in  the  reeelnder  of  thie  eeotion. 

The  oholoe  of  winiiurenent  typee  deterninex  the  obearvetion  eatrix  H  and  the  oovarianoa  R  of  obaervetion 
ncleej  in  Equation  (2.3).  A  loop  with  the  aeeuMd  obuervetion  tleee  xnd  the  initial  value  P,  for  P  ,  the 

four  Mtrloee 


<t> ,  a  ,  h  ,  r 

completely  deteralne  the  oomputetlor,  of  the  etate  ooverier.o*  matrix  P  end  henoe  ohareoUrlae  the  error  enalyel*.  * 
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3.3  the  Said  lit*  Navigation  Problem 

Tb«  petition  and  vtloclty  of  a  vthlolt  In  ttrtb  orbit  tit  usually  calculated  from  t  series  of  neaauramenti 
udt  by  ground  radar  itationa  and  lnstrumenti,  tuoh  tt  horlnon  traders,  ttar  traokari  and  landmark  teltioopti, 
loctttd  on  board  tho  vshtcla,  in  ordtr  to  oompara  tht  Barits  of  variout  combinations  of  instruments,  It  it 
nacsiaary  to  aatliatt  tha  not  accuracy  wltn  which  any  particular  combination  predicts  too  it  Ion  end  vtloalty 
tad,  in  toaa  cases,  vthiclt  attltudi,  If  it  it  assumad  that  a  minimum  variance  filter  it  employed  to  prooeea 
the  data,  then  Equations  (3.1)  or  (3.1)'  and  (3.3)  give  the  itoond-order  statistics  nf  the  notltlon  and  veloolty, 
and  of  any  ether  variablet  included  in  the  itato  veotor,  If  tho  filter  It  linear,  but  not  ntceattrlly  minimum 
variance,  then  Equation  (2.3)  it  to  be  replaced  by  Equation  (2.7)  to  achieve  the  tame  roaulta. 

Tht  to ope  of  the  orror  analytln  it  etaent tally  determined  by  thu  choice  of  (a)  tho  atate  veotor,  (b)  the 
Dtea'ireannt  typea.  and  (c)  the  realltm  dttired  in  determining  when  the  meaaurementa  occur,  Tht  last  oontldera- 
tion  ehould  not  be  overlooked  aa  a  faotoi  in  the  complexity  of  a  digital  computer  program. 

Tht  moat  convenient  pitot  to  etart  tht  analyala  of  t  practical  filter  pro'-iem  euah  as  thle  hoe  been  found  to 
he  with  (b),  the  meaiurement  typo,  rather  than  with  the  atate  vector.  The  reaaon  la  that  many  of  the  variable! 
in  the  atate  vector  are  noleoa  or  bltitt  originating  in  the  Maturing  instruments.  In  addition,  t  deft  deflni- 
tion  of  tho  atate  varlabloi,  auggeated  by  thu  meeeurement  matrix,  often  rsouooe  the  complexity  ol  the  etete 
transition  matrix.  Hence,  the  observation  typea  win  be  dieouaaed  In  Section  2.3  and  the  choice  of  atate  vari¬ 
able!  In  taction  2.4. 

Tha  lnmrtial  coordinate*  X  ,  Y  ,  Z  dssorlblnf  tha  vehicle  petition  are  ahown  in  Plgura  1,  and  tha  rthlole 
vertical  coordinate*  f  ,  $  ,  i  art  ahown  In  Figura  3. 

3.3  Ubaarvation  Typea 

fb«  purpose  of  thi*  aaotlon  la  to  daaorlba  tome  of  the  observations  that  ara  oooaonly  used  in  attaints  orbit 
determination,  Table  1  1 lata  tha  H-aatrloaa  eorraaponding  to  thin  obaarvationa. 

Ground  Band  fladar 

Piiura  3  ahowa  tha  gaoMtry  of  a  traokln*  station.  Tht  four  obaarvationa  ara 


8  *  \P\  ■  range  '  (3,t) 

A  ■  (f  «  ranit  rnta  1  (3,  io) 

A  u  tan**  W>.»/p,a)  ■  ailnuth  (3.11) 

E  a  tin’1  (p.fi/p)  ■  elevation,  (3.13) 


where  tha  symbols  used  ara  defined  In  Figures  1.  3  and  3.  Each  of  that*  obaarvationa  la  affeotad  by  the  vahlola 
position  and/Mr  velocity  and  ean  bo  expected  to  glva  partial  orbit  datarmlnation  Information.  Howtvar,  tha 
uncartalnt  law  A#  ,  An  ,  Ah  of  tha  station's  own  location  ara  a  major  source  of  error,  con  curable  to  tha 
noise  level  on  range,  and  must  be  considered  aa  variable!  in  the  state  vaotor  In  any  realistlo  error  analyala. 
Table  I,  therefore,  ahowe  tha  H*a«trioaa  eorraaponding  to  station  loeatlon  errors  aa  wall  aa  to  vahlola  position 
and  vtloclty.  Finally,  tha  blaaaa  un  range  and  rang!  rata  and  in  euiauth  and  elevation  ara  often  Important  and 
ara  also  shown  In  Table  I.  These  bleats  ara  danotid  by  Ap  ,  txp  ,  AA  and  Ae  , 

Inertial  Mtaturnunt  Vrit 

Moat  axparlmanta  carried  on  a  latolllta  require  luowladgt.of  tha  vehicle's  orientation  In  Inertial  apaoe  in 
order  to  produce  uuiful  data,  alnea  It  la  often  lapraotlcal  to  control  tha  vehiole's  attitude  praclaaly,  a 
gyroaooploally  rtablliaad  platform  ia  oftan  raquirad,  Exparlmahtal  obaarvationa  art  than  aada  (parhapa  using 
tha  vahlola  Itself  aa  an  lntarwadlate  coordinate  fraaa)  relative  to  tha  gyroaooplsally  atablllmad  axaa.  Thn 
atubUtaJd  ooordlnata  frame  itaalf  may  be  rsfeionotd  to  inartlal  apace  by  a  star  traoker  that  aakia  obaarvationa 
of  two  or  mors  start.  It  win  be  aaswtii  that  tht  gyroaocploally  stahUlisd  axes  ara  aaintalnad  coincident 
•Itlwr  with  tha  lntrtlal  axaa  XYZ  of  Plgura  1  or  with  local  vartlcal  un  f  of  Plgura  3.  Hurt  ntnaaiary. 

tha  two  oaaaa  till  be  distinguished. 

Obaarvationa  aade  ralativa  to  tha  gyrotoopioslly  atablUatd  (IMV)  axaa  will  oontaln  errors  due  tc  tha  dis¬ 
crepancy  between  th*  true  end  tht  indiaatid  orientations  uf  tha  IMV.  This  dltorspanoy  may  bo  rapraiantad  aa 
email  rotations  ,  Q)  about  tha  IMU  gyroscopic  axes,  i.a.  along  tha  XYZ  or  f <K  axes.  Thais  gyro 

angles  (9l,Gl,9))  will  ba  naadad  in  tha  state  veotor,  not  only  baoauaa  they  ara  important  errors  In  many  of  the 
obrsrvatlons  to  ba  deeoribed,  but  baoauaa  they  ara  a  larga  part  of  tha  attltuda  error  of  tha  vahlolg,  In  many 
missions,  attltuda  has  an  Importance  equivalent  to  that  of  poeitlon  and  veloolty.  A  suitable  modal  for  , 

9,  and  9.  will  ba  dtacrlbad  In  tit*  aaotlon  dealing  with  the  state  variable!,  it  should  ba  noted  that  only 
tha  attltuda  indioation  of  tht  IMU  la  of  Intaraat,  alnea  Its  icoalarotMters,  if  any,  give  practically  no  output 
In  tha  abianoa  of  thrust,  tha  oaaa  under  consideration. 


.,*•  *>  ,% 


Horizon  Traekir 


A  horizon  traoker  may  be  pictured,  tor  the  oeke  of  error  analysis,  as  tour  Independent  etihtlni  teleioopem, 
two  polstini  to  the  forwerd  end  backward  horizon*  In  the  orbital  plane,  and  twn  pointing  to  the  left  and  right 
horizon*  in  a  plane  normal  to  the  orbit  (see  Figure  4).  The  tracker  meaauree  the  four  angloa  4>t  ,  4>a  ,  4,  , 

4,  of  the  teleeoopoa  relative  to  the  ooordlnate  frame  at  the  vehicle.  Theee  eng  lee  are  oomhinod  to 

give  an  average  itadimotric  angle 

9,  -  i^-4,  +  4,-4,)  (a.  13) 

and  two  anglea,  9,  and  9,  ,  that  indicate  the  dlraotlon  of  the  local  vertical  relative  to  the  ooordlnate 

frame: 


9,  =  +($!  +4*,)  (3. 14} 

9,  *  ‘1(4, +4,)  .  ..  (3.  is) 

One  of  the  major  errora  in  these  observation*  is  In  the  deviations  h,  ,  h,  ,  h,  ,  h,  of  the  sensible  horlton 
heights  from  their  assumed  values  H1  ,  H,  .  Ha  ,  ll„  .  Corresponding  to  the  errors  Sia  ,  s9,  ,  5$a  In  the 
observations  of  Equations  (2.13),  (2.14)  and  (2. IS),  there  are  three  combined  horizon  deviation*, 

£,  «  i(ht  +  h,  +h,  +  h,)  »  i'(R'-r{„)  S9,  (2.18) 

E,  *  i(hj-h,)  «  */(R*  -  ItJH>  (2.17) 

E,  *  t(h„-h,)  «  /(R'-Rj*)  l>9,  ,  (2.18) 


where  R  1*  the  dlstanoe  free  the  center  of  the  earth  to  the  vehicle  and  RCH  la  the  distance  from  the  center 
of  the  earth  to  the  Assumed  horizon  altitude,  It  la  poasible  to  take  these  combined  horizon  deviations  as  three 
Independent  state  variable*.  A  convenient  model  for  them,  oonslntlng  of  time  correlated  zero-mean  noises,  will 
be  discussed  la  the  nut  section,  in  addition,  It  la  often  necessary  to  consider  the  bias  errors  In  the  9,  , 

9,  ,  9,  observations  produced  by  a  oongtant  error  in  the  estimated  horizon  heights,  Such  an  error  will  produce 
a  bias  In  ,  but  not  in  9,  and  9,  .  Hence  it  la  often  realietlo  to  Introduo*  a  state  variable  Ai^  for 
horison  bias  effecting  the  stadlaatrio  angle  9a  . 


A  second  major  error  in  the  combined  observation*  1*  in  the  tracking  Instrument  Itself,  Instrument  errora 
appear  In  the  angles  4l  ,4,  ,  4,  ,  4,  and  heno*  In  9,  ,  9.  ,  9.  .  To  describe  them  one  nay  postulate  com¬ 
bined  Instrument  errors  gf>,  ,  <5,  ,  <?,  ,  These  errora  may  be  introduced  as  time-correlated  variables  In  the 
state  vector,  if  a  suitable  sodoi  is  found.  A  rather  oomplets  nodal  would  Include  blase*  A91  ,  A9,  and  A9, 
and  purely  whlte-nols*  components,  in  general,  the  time  constant  of  the  tins  correlated  error  is  snail  enough 
to  allow  this  error  to  be  considered  as  whlts-noise, 


A  third  error  that  appears  In  tha  horison  trackar  obaarvationa  la  that  dua  to  tha  IMU  srror  angles  9.  , 

9,  i  9,  ,  Hart  tha  two  casta  of  (Mil  orlantatlon  suat  be  distinguished,  Morsovcr,  errors  in  IMU  orientation  do 
not  affect  the  stadlmetrlo  angle  9,  ,  but  do  add  directly  to  the  observations  9,  end  9,  of  the  vertical, 

In  ausmery,  Table  1  Hats  the  matrices  relating  the  effect Ivt  horison  tracker  obaarvationa  9,  ,  9,  ,  4a  tc 
tha  following  variable*  in  tha  atita  vector:  vthlole  posit  ion  errors  x  ,  y  ,  *  ;  eff active  horlton  deviations 
E,  ,  E,  ,  R,  :  IMU  error  anslaa  9(  ,  9,  ,  9,  ;  affaotiva  tracker  errors  ,  it  ,  5,  ;  affective  horison 
tracker  biases  A4,  ,  A4,  ,  A4a  :  horizon  dsvlstion  bias  Ah,  . 

■Star  Traekir 

A  iter  tracker  provldsa  highly  aoourata  attltuds  information  to  tha  IMU  uaa  and,  thereby,  to  other  instru¬ 
ment*.  Tha  obaarvationa  art  train  angle  (TR)  and  tlavstlnn  angle  (EL),  relative  to  the  (Mu  reference  frame, 
at  the  unit  veotor  from  the  vehicle  towards  tha  star,  Figure  8  shows  thaaa  obaarvationa,  Nett  that  hare  TR 
and  EL  era  measured  relative  to  tha  vahlola  vertical  coordinates,  even  if  tha  IMU  axes  era  alont  XYZ  .  For 
alapllolty,  tha  atm*  gaoaatry  la  assumed  for  star  and  landmark  obaarvationa. 


Tha  errora  In  tha  TR  and  (L  obaarvationa  are  these  in  tha  instrument  Itself  and  in  tha  IMU  orlantatlon, 
bacauaa  star  directions  art  known  with  high  precision. 

Tha  inatruaant  error*  ar*  divided,  as  usual,  Into  two  correlated  errors  n,  ,  Q,  ,  bias  errora  ATR  ,  A  EL  , 
and  pur*  ehitt-nolee,  Tha  total  Inatruaant  arror  la  often  of  tha  order  of  arc-saonnds. 

The  IMU  orientation  errors  9(  ,  9,  ,  9,  usually  dominate  the  total  arror  If  sort  than  a  few  minutes  have 
alapeed  alnoa  tha  last  star  obaarvationa. 
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Lanekarh  Sinior 

Observation  of  i  landmark  of  known  location  on  the  «»rth  may  bo  made  with  n  taleacopo  by  a  orow  member. 

Tht  geometry  of  k  landmark  obaarvatlan  U  assumed  to  bio  n  ini lnr  to  that  of  a  atnr  observation  (see  Fleurs  B). 
Rut,  lino*  the  landmark  is  not  at  Infinity,  aa  la  a  ntar,  the  observation  la  affected  by,  and  hence  yieldn 
Information  about,  tha  vahlola'a  poaltlon  aa  wall  as  Its  attltudo.  The  errors  involvad  may  be  modelled  aa  time 
oorrslated  errora  ,  vf  ,  bias  errors  ATR  ,  A  EL  ,  and  pure  white-noise,  Just  aa  In  the  case  of  the  star 
tracker. 

As dar  Altimttr 

This  instrument  aeaaurea  RA  ,  the  distance  IS-K(a|  between  tha  vehlole  and  the  sub-satellite  point 
(tea  Figure  0).  It  involves  only  the  position  variables  of  the  state,  aa  shown  in  Table  I. 

Hie  major  errora  in  the  obeervation  are  in  knowledge  of  the  altitude  of  the  sub-satellite  terrain,  in  tidal 
heights,  and  in  the  instrument  itself.  The  characterization  of  the  terrain  unoertalnty  as  a  time-correlul 
first-order  Markov  process  is  valid  only  an  a  first  approximation,  since  this  error  ie  highly  orbit  dependent. 

The  rtder  altimeter  information  l,i  restricted  to  the  radial  direction,  aa  may  be  seen  in  Table  I.  Hence 
orosa-trsok  end  down-track  errors  cannot  bo  removed  by  this  observation. 

1.4  Itate  Vsotori  the  0  and  4  Matrices 
2.4.1  Partitioning  /or  Aioaes 

Tht  variables  introduced  in  flection  3,3  from  aiamtnetion  of  ths  observations  will  be  inoluded  in  the  state. 
Table  H  ligte  those  state  variables  that  are  not  biases!  Table  lit  Hate  the  bias  variables.  The  total  number 
of  variables  ie  seen  to  be  olose  to  BO,  li*  only  one  ground  radar  is  uaadi  if  a  computer  program  were  oonetruoted 
to  oaloulat*  tho  baelc  covariance  equations,  Equations  (3.1)’  and  (33)  an  thay  stand,  approximately  3900  Com- 
puter  locations  would  be  required  for  each  of  the  PJM  ,  Pj  ,  and  Q  eiatrloea.  Moreover,  0.38x10'  opera¬ 
tions  (multiplies  end  adds)  ere  required  for  a  single  eatrix  produet  such  ea  $ P  .  At  10  mioroasoonda  par 
operation,  Equation  (2.1)'  alona  would  riqulre  about  S  aeeonda  of  oomputar  time.  When  six  or  mora  ground  stations 
are  employed  elmultaneously,  the  number  of  mtate  variables  is  about  SB,  each  matrix  requlrae  about  7300  locations, 
and  Equation  (3,‘i)'  requires  about  3B  seconds,  tt  la,  than,  olasrly  impossible  to  simulate  a  ona  or  two  day 
■lgsloa.  In  which  thousands  of  observations  are  made,  eithout  onnauming  larva  amounte  of  oomputar  time  and  apaoa. 

It  la  poaalble  to  alleviate  oonaiderably  the  computer  storage  and  tin*  problem  by  (1)  processing  only  one 
(aoalar)  observation  at  a  time  and  (3)  partitioning  Equations  (3.1)'  and  (3.3)  Into  sub-matrices  for  tha  bias 
variable!, 


(1)  If  the  Dales  ooverlenoe  S  in  Equation  (3,2)  is  diagonal,  It  la  possible  to  proaeee  one  row  of  the  H  matrix 
at  a  time.  (As  pointed  out  In  Reference  4,  it  la  always  passible  to  transform  Equation  (3,2)  so  that  R  le 
diagonal.)  This  avoids  amt r lx  inversion  and  aavea  on  storage  epees  for  PHT  .  Equation  (2,2)  la  then 

P*  »  r  -  (P‘H2)(P‘Hj)T/(H|1P-Hl  +  >lk>  ■  (3.18) 

where  le  the  ktk  diagonal  element  of  R  and  Hk  la  the  kth  row  of  H  .  Equation  (3.1)'  ie  still 

PJ  •  <*(t1,tt.l)Pj.l0T(t1,*1.,)  ♦Qrtj.tj.j)  .  (3.30) 

(3)  Pure  bite  etetee  have  identity  element  a  in  the  state  transition  eatrix  and  [o]  in  tha  Q  matrix.  Parti¬ 
tioning  Equation  (J3.30)  gives 
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Here  ■  stands  for  bias,  s  for  something  else. 
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where 


a  ■  Ht(t)P,(f)  + 

P  •  Ht{t)P„<r)  +  H„(t)p„(t-) 

0  -  H,(t)P#(t-)Hj(t)  +  B(t> BT(t>  +  3Hl(t)Pg|(t‘)Hj<t)  +  Rk  . 
The  fir  it  of  theee  two  equetione  ny  bt  lumir  trod  11 


p,(t-)  =  ^t(t.t0)p,(t;^(i,t0)  +  Q,a.tt) 

pgi(t-)  = 

p.(f)  *  p8<t„*> . 


TIME 

PROPAGATION 


<a  38) 
<2.  26) 


(3  37) 
(2. 28) 
(3.  29) 


The  etcoad  aay  bt  turner laid  u 

‘  Pg(t*)  *  P,(f)  -  aVt)  |  (2.30) 

p..<f)  -  p1|(n  - immmm 

•  p,<t*)  ■  P,(f)  -  /J^D  ,  _ |  (2.32) 

whir* 

a  ■  H4(t) Ps(f)  +  Hl(t)Pj,(t")  (2.33) 

P  ■  H,Ct)Pt|(r)  +M|(t>P|(t*)  (2.34) 

0  •  anj(t)  +  UHg(t)  +  1^  .  (2.38) 


Tlw  abort  tlat  and  data  tquatlona  art  forma  that  nay  bt  progrinmed.  tl>s  foraer  art  uatd  to  ixtrapolatt  thi 
trror  Mtrlota  r,  ,  P,,  ,  P„  from  t0  to  t  in  tht  aba  met  of  OHniermnntii  tho  latter  art  uttd  to  rt-ivaluatn 
P.  ,  P,,  ,  P,  at  tin  t  ,  onot  for  taoh  aaanurament ,  It  will  bt  not  leu  that  a  and  P  art  row  natrloan, 

Ct‘a  ,  $*P  art  aquart  aatrlott,  (nrfl  it  a  rtotaniular  natrix,  and  D  it  a  toiler. 

3.4.3  Squatiom  for  <P,  and  Q, 

Tbt  atatt  traneitlon  natrix  d>,  for  tht  trror  vector  of  Tablt  II  it  obtained  from  thi  dettrainlatio  dtecrip- 
tlon  of  tht  trror  prooata,  in  tht  lnttirattd  fora 

f(t)  W  *B{t.t#)I(t,)  +  /‘^(t.O-JIKcr)  do-  ,  (3.38) 

*0 

whtrt  X  it  tht  trror,  <)>%  ltn  atatt  tranaition  natrix  and  Hfcr)  tht  drlvint  noitt. 

Tht  flg  natrix  it  obtained  at  the  ooverienot  of' the  inteiral  on  the  riiht  tide  of  the  Equation  (3.36): 

l  »  f  d\  dA4.‘#»i(t.X)Btn(\)HTCM)]0lct,A*>  .  (3.37) 

■t0  «t4 

where  B[  ]  lndloatee  oipeotation, 

la  praotlot,  the  and  Q_  natrinee  art  thtnelvee  partitioned  into  gub-natriotn  appropriate  to  thi 
natural  irouplnn  of  variablee  in  the  atate.  For  the  errort  ehuwn  in  Table  II,  the  partitioning  of  Figure!  7 

and  8  are  appropriate  for  <4,  and  Q,  .  retpentively.  Note  that  the  dynaale  biatte  In  ,  SoN(l)  .  5CN(4)  , 

JDQ/Dn  have  been  retained  in  <£,  btoauee  they  affeot  petition  and  veloalty  rla  gt0  .  The  rarloue  non-xero 
aub-aatricta  of  riiuroa  7  ond  8  will  now  bt  dleouated. 

Vehicle  Volition  and  Velocity 

Thaee  art  the  trror  quantities  of  primary  internet  In  meet  applii.atioiie.  A  cl  need  fon  for  tht  two-body 
itate  tranaition  natrix  itv  la  liven  by  Koohl'1'.  A  reaiietio  pioture  of  error  propagation,  however,  includes 
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tha  effects  of  uncertainties  In  tha  earth's  gravitational  parnmvter  /i  ,  in  tho  tonal  harmonica  of  the  geo- 

potantlal  Cj  ,  i  “  3,3,4 .  and,  far  low  altitude  aatellitaa,  tha  uncartalntlaa  In  air  drag,  A  method 

for  treating  three  three  olaeaea  of  unonrtuint lea  an  blanee  (conatant  errorn)  in  given  in  Appondlx  B,  A  more 
eophietioated  treatment  for  air  drag  la  warranted  in  many  oaaae’'11  and  nxtenaive  modela  have  been  developed 
for  the  arrore  in  the  geopotentlnl1*’ ",  Tha  equations  of  Appendix  B,  however,  are  adequate  to  predict  tha 
oorreet  order  of  magnitude  of  dreg  and  potential  errora  for  aarth  orhlta  from  about  BO  to  500  mllea  altitude. 

In  particular,  tha  comparatively  large  arrora  produced  by  the  unoertalnty  In  Cf  can  ba  accurately  predicted 
by  theat  aquatlcna. 

Tha  atate  tranaitlon  eub-matrix  any  ba  calculated  by  numerical  integration  and  filled  into  $(  aa  ehown 
in  Figure  1.  The  portion  of  oorreapondi.ig  to  position  and  valoolty  le  goro,  as  ehown  in  Figure  B,  If  dreg 
lg  treated  eg  a  blaa  in  Dg  .  Thin  portion  of  Q,  would  be  non-zero  if  a  etochaatio  drag  modal  wore  used. 

Gyro  Error e 

The  model  of  gyro  drift  la  taken  an  a  fixed  drift  rat.o  plus  drift  rate  nolae: 

pt 


where 


&( t)  a  total  angular  error  about,  input  axle  of  gyro 


to. 


>  initial  gyro  drift  rata 
a  gyro  drift  nolaa  time  conatant 

■  unoorrslzted  drift  noise 

■  gyro  drift  rata  blaa, 

Tha  gyro  drift  rata  prooaaa  ltaalf  la  taken  to  be  whitn-noiae  through  en  RC  filter: 

<o(t)  -  w(t0)«*|(‘'t|,>/T#o1  +  fle'i(t',0/T“Dl  Vcr)  do  ■ 


'DD 

Ta 

co. 


<a.3B) 


'tha  gyro  drltta  about  each  of  the  three  orthogonal  IMU  sxaa  era  eeeumed  to  ba  mutually  independent  end  each 
followa  tha  modal  of  Equations  (3.38)  and  (2.30),  A  more  refined  model  involving  time-dapendent  drift  rata 
would  ba  netdad  for  long  parloda  of  gyro  operation  without  reset:  such  a  coin  would  ocuur  if  reentry  or  manauver 
had  to  bm  made  long  after  star  tracker  failure.  Tha  preatnt  nodal,  however,  it  adequate  for  non-failure  mode 
operation. 


Whan  tha  oovarlanoan 

of 

0<t ) 

and  u(t )  era 

taken  for  the  three  gyros,  tha  combined  state 

for  gyro  anglae,  'drift  rata 
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and  drift  rata  biaaaa  la 
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The  Covarlence  matrix  of  th«  accumulated  noiaa  la 


where 


and 


Horiion  I'-via tiom 


A  *  +  t0D(1-X')  -4t0D(1-X)) 

B  -  ■'nVond-X)1 
0  =  crQfu(l-x‘)  • 

cao  -  variance  of  gyro  drift  nola# 


(3. 41) 


Tha  oomblnad  horlsion  deviation  h k  ,  R,  ,  h,  art  dependant  on  the  actual  horizon  daviatlona  h,  ,  h,  ,  h,  , 
h,  at  tha  polnta  of  tannnoy  of  tha  talauoapio  linaa  of  alaht  and  the  aanaad  horizon.  Par  a  raaaonahla  approxi¬ 
mation,  one  may  assume1'  that  h,  ,  h,  ,  h,  ,  h„  art  oorralatad  In  time  and  location  with  an  autocorrelation 
funct ion 


cr(r,  5) 


pj,  -  |8/*hI 


(a. 4a> 


where  r  la  the  time  between  maaeuramanta  of  daviatlona  h  in  heiibt  of  horizon  polnta  aeperated  by  a  dlatanaa 
3  ,  rH  and  arc  oonetante  determined  by  obaervatlon,  Here  o-L  la  tha  variance  of  ht  ,  h.  ,  h,  ,  or  hH  . 
Thla  approximation  la  applicable  to  tha  Co,  14-13  nlaron  apectral  band.  Uainj  tlila  autocorrelation  filiation, 
and  taklnc  into  account  the  vehlola  velocity  but  linorini  the  oorralatione  due  to  the  ndjaoanoy  of  euocaeelve 
orbits,  Wilcox"  has  oaloulattd  the  variance  of  tha  position  error  alona  tha  vartioal  aiia  |  as 
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4 


7hd 


(2.43) 


and  tha  varianoa  of  tha  position  errors  alona  tha  horizontal  axil  v)  and 

K'(l-b)  , 

(r1  -rJ)'  c'hi>  ' 


aa 


(2,44) 


where 

.  „  #-(i/*h> 

1,  =  ,-(i/»h)  ««•  '*  (*«/») 

Rf  a  redlus  of  earth 
<tJb  «  variance  of  h,  ,  h,  ,  h,  or  h,  . 

in  taram  of  the  errore  S?,  ,  Sj,  ,  8$,  In  the  combined  tracker  nbaervattona,  the  vertical  position  error  la 
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»nd  the  horizontal  position  srrors  ara 


Combining  Ecuatlone  (2,48),  (2.43)  and  (2.14)  fivss  tho  variance  of  h,  : 


and  ths  variances  of  S,  ,  F, 


var(ii,)  =  crJD 


var(K,)  =  aj01  =  o-Jo 


var(5,)  =  <4,  =  a>D  .  (2.49) 

The  three  combined  horizon  deviation*  may  thus  be  oonslderad  as  the  outputs  of  three  firat-order  linear  eyatens 
driven  by  three  Independent  white-noise  source*.  The  model  for  each  Is 


H(t)  =  H(t0)o‘  l(t-t0)/rH|  +  J^-Kt-O/rJ^ 


The  0  and  q  for  the  three  deviations  are 


An  =  ° 


I  (t-t0)/v(1D|  jj 

„  i-|<t-t,)/vHD| 


^o.O-y’) 


Ad  a  ° 


cr*  (1-y*) 


and,  as  shown  In  Reference  18, 


,  ,  ,-l(t-t0)/rHD| 


rHU  =  • 


where  T0  Is  the  orbital  period  of  the  satellite. 

Horitan  Tracker 

The  combined  Instrument  errors  ,  5,  ,  &,  ,  are  illustratod  in  Figure  4.  The  deterministic  model  for  enoh 
is  that  of  white-noise  through  an  RC  filter,  the  three  noise  components  being  assumed  unoortalated  with  each 
other.  The  model  for  eauh  error  le 
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time  eonstant  ( 

It  a  four-telesoot)e  tracker  U  employed,  as  described  In  Bastion  a.  3, 

<r‘T1  =  o*T/4  (2.58) 

aHT»  =  .*HTi  =  ■  <2-8»> 

whr m  crJT  Is  the  acturvl  variance  of  a  simile  telescope  angle. 

Star  Traaktr 

The  tlua  correlated  errors  in  the  star  tracker  train  and  elevation  anile  are  shown  In  Figure  5.  The  error 
process  for  each  is  assumed  to  be  white-noise  throuth  an  Ml  filter,  the  two  components  belna  uncorrelated  with 
each  other: 

fl(t)  ■  0(»#>.*l<t*t«,/,'»l  da.  (2.80) 


The  state  traneltlcc  matrix  and  nolle  matrix  ere 

r#-|(t-t0)/rit| 


'°aTi(l -•**l*,**®>/'  'v  0 

o  «W» 


0 

t*l (tte)/v4T|^ 

0 

oJT|(l-e*‘l<t‘t«,/T«l) 


"it:  a  variance  of  star  tracker  train  anile  error 
°su  «  variance  of  star  tracker  elevation  angle  error 
r|T  *  correlation  time  of  star  tracker  errore. 


landmark  Senior 


The  time  correlated  nolsea  In  the  landmark  sensor  train  anal*  and  elevation  anile  (PI*. 5) ,  are  state  variables. 
The  error  prooeae  for  each  le  assumed  to  be  white  noise  through  an  RC  filter,  the  two  components  being  uncor¬ 
related  with  eaoh  other: 

n(t)  a  ff(t,)e'l<t'to,/Ttel  +  J*  e"l(t'rt/T>'el  do  ,  (2.83)' 

The  state  transition  aatrix  and  noiee  matrix  are 

’>*l(t*t9)/r(jil  „ 

'  [o 

— e"*1  ^"^o^^e1)  o 

Qfj  3  .lei  a  »/_  |  >  (2.68) 
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2.5.S  Gyro  Mltal  igruMnt  CovurlanrtM 

The  elaaenti  of  Pi(1  far  I,J  -  7,8,8  ere  the  covnrlunces  of  the  gyro  miaalignments  along  platform 

ta»  1,3,3.  If  the  platiform  axe*  coincide  with  the  looal  vertical  no  trana  format  ion  ia  needed.  If  the  platform 
aaee  coincide  with  the  Inertial  coordinate  frame  a  transformation  to  looal  vertiaal  axes  Is  needed.  The  calcula¬ 
tion  ia  as  followe: 


ao»{9LV5jv}  =  oov{(81'3,Hst§,1t} 


=  STP, 


eO.e,*) 


a  , 


(2,771 


where  S  is  ea  above,  Pi(Ii,it)  is  P, ( t > for  I, J  =  7,8, B  and  8  ia  the  vector  gyro  misalignment. 

2.5.4  Vehicle  Attitude  Covariances 

The  vehicle  attitude  error  ?  is  the  sum  of  gyro  Blaelisnment  0  and  the  rotation  error  e  due  to  position 
and  Yeloolty  errors: 


y  =  d  +  7. 

7:  6  + 


(2.78) 

(3.78) 


where  are  the  looal  vertiaal  unit  veotors  of  Fiiure  3  and  SR  ,  5V  are  position  and  velocity  error. 

Faototlng  out  BR  and  RV  fives 


*  #  +  [0A]  'S'  ,  where  f  »  |  *V } 


(2.80) 


(INI8TIAL) 


and  [£>.]  la  known  in  terms  of  K  and  V  ,  in  inertial  coordinates.  If  9  la  in  s  lootl  vsrtloal  system,  the 
attitude  aovtrlanoe,  in  looal  vartloml  ooordinatea,  is 

a  aov{(sT#,  ♦  rt[(9,]1S)(btSi  +bt[0a]V)t} 

«  oov{s’(?,t[<9A]«)(^+ST[eA]T)8> 

a  Bt  coyiSjdj  +  [0A]l#J  r  8'sTT[ffA]T  +  [eA]WT[0A]T}8 


where 


®T[pe(M)  +  ^pa(x«)  +  pe(«x)^T]  + 

iy.(x.>^ 

pe(rr) 

*  Pe(I,y) 

for 

i 

a  7-8  , 

j  = 

7-9 

p»(xv) 

=  Pe(I,y) 

for 

i 

a  1-8  , 

J  a 

7-9 

Pa(W) 

•  p.(I,J) 

for 

i 

a  7-8  , 

J  * 

1-8 

Pa(xx) 

=  pt(l,J) 

for 

i 

a  1-8  , 

J  * 

1-8  . 

(3.81) 


If  9  is  in  an  lnsrtlel  frame,  the  attitude  ooverlence  iu  local  vartloal  coordinates  is 
oovfylv7jv}  *  oov((5LV  +  STl'9A]30(?LV  +St[Sa]50t} 

s  oov{?Lv^v)  +St[SaJ  oov{S$Jv)  +  oov{?mTt} [9a]tS  +  BT[5A]oov{SfT}[5A]T8 

-  p.(rr)  +  8tt«a^.(,r)  +  p.(va)  ^  +  Sr[0A]P„„,  [*A]T8  ,  (2.82) 

The  remainder  of  the  aovtrlanoe  matrix  la  readily  interpreted  end  needs  no  transformation. 

1.8  Determining  the  Times  of  the  Observations 

The  loiio  end  search  procedures  that  must  bo  programmed  to  simulate  raaUatloaU:1  the  timee  at  whloh  obftrva- 
tlone  are  made  may  constitute  alaoet  half  of  the  computer  progrto  ending. 
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2.6.1  Ground  Baud  Radar 

Moot  radar  cbiervatiooa  taken  with  tho  antenna  at  a  low  alavatlon  angle  aro  unrtllablo  ami  are  direardod. 

A*  a  rcault  any  one  radar  ear  rako  readlnaa  only  when  the  vehiolt  la  within  a  oone  extending  out  from  the  radar 

atatlon  and  with  lta  axis  along  the  local  vertical  of  the  etnlion.  Typically,  the  half-cone  angle  la  between 

80°  and  89°,  The  maximum  range  of  tho  radar  puta  a  apherlcal  cap  on  thia  cono  of  visibility.  A  aearoh  procedure 
aust  determine,  for  each  radar  in  tho  tracking  not,  whother  tho  vehicle  ,'alla  within  this  cone  of  visibility. 

The  rotation  of  the  earth  complicates  tho  picture  in  a  minor  way.  A  variable  search  atop  la  found  to  bo  lndla- 

penaibla,  in  aany  oaaea,  to  avoid  excoaaive  computation  time. 

1.6.2  Horiion  Tracker 

Thia  Instrument  la  limited  in  operation  only  by  the  powor  and  data  proceaslng  capacity  of  tho  vohlole. 

2.6.3  Star  Tracker 

The  majoi  considerations  in  determining  the  tines  of  observation  for  a  star  tracker  aro  (a)  stellar  magnitude, 
(b)  obscuration  of  the  star  by  the  earth,  and  (o)  adequate  angular  separation  of  atars. 

2. 6. 4  Landmark  Sinter 

The  considerations  here  are  very  similar  to  these  for  the  ground-bleed  radar  observations.  Indeed,  the  sane 
search  procedure  (coding)  may  be  used  for  landmarks  as  for  redan,  with  suitably  dlffaront  paranatern. 

2.6. 5  Radar  Altimeter 

It  1*  usually  desired  to  investigate  the  effect  of  operating  tha  altimeter  only  over  water,  since  the  tidal 
uncertainty  is  much  less  than  the  terrain  uncertainty  and  easier  to  detenaint,  Storing  a  facalmlle  of  the  land- 
eet  configuration  nay  be  avoided,  for  error  analyuie  purposes,  by  allowing  altlmetrio  reading!  for  a  fraction 
of  the  time  corresponding  to  tha  percentage  at  wgtir  underlying  the  orbit. 

8.7  Results  of  Typical  Computer  Rum 

The  results  of  a  typical  computer  program  for  on-board  measurements  alone  ere  ruaorded  end  discussed  in 
Reference  18.  The  Instruments  employed  are  horlaon  tracker,  star  tracker,  ridar  altimeter.  Tha  computer  rune 
indiomte,  among  other  things,  the  oscillatory  nature  of  cross-trick  arror,  tha  value  of  a  radar  altimeter  in 
•  wwoiriottttig -eh#  ‘goauaulatlon  of  down-track  wrrore,  and  the  futility  of  increasing  the  horizon  tracker  data  rate 
beyond  the  limit  set  by  the  horizon  deviation  tint  conntant. 

The  results  of  a  typical  computer  program  that  combines  both  on-board  and  ground-based  data  are  shown  in 
Figure  10.  This  computer  run  aseused  three  radar  stations  traoklng  a  satellite  in  a  280  nautloal  miles  olroular 
orbit.  Oround  radar  range  readings  ears  taken  at  10,  22  and  24  hours.  They  have  a  bias  of  30  ft,  white  noise 
of  10  ft,  station  location  bluee  of  As  =  An  =  76  ft  .and  Ah  =  28  ft  ..  The  on-bomrd  horizon  tracker  was 
asauaed  to  have  a'blas  of  0.018  deg  end  a  noise  variance  of  0.28  del*  with  a  1  second  time  constant.  The 
horlaon  devlatiana  wore  aasuaed  to  have  KS£H  =  2800  nautical  ailei,  and  a  variance  ^hd  =  1.4 (nautical  miles) '  . 
A  star  tracker  with  0. is  deg  bias,  1  second  time  constant  and  4  »  10' ‘(del) 1  variance  was  assumed,  along  with  a 
radar  sltlaeter  of  0.01  nautical  alls  whito-nolie  and  0.008  nautical  mile  bias.  These  results  are  not  realistic 
beyond  about  ons  day  of  orbital  Ume,  because  ns  drag  or  unoertaintisa  in  the  gravity  model  were  included. 

When  drag  bias  SD0/ag  and  gravitational  bias  ,  but  not  biases  In  Cn  ,  are  accounted  for.  an  error 
analysis  of  ground  radar  tracking  yields  results  such  as  shown  in  figure  11.  The  radar  location  biases  of 
200  ft  in  each  of  As  ,  An  ,  Ah  were  estimated  during  the  run  and  at  13.2  hours  were,  on  the  average,  141  ft. 
Rader  range  readings  wers  taken  at  times  indicated  by  a  solid  triangle  in  Figure  11.  The  program  also  attempted 
to  estimate  Sfi  ,  5cf  ,  Sc,  ,  Sc,  end  SC,  ,  but  no  significant  ohangei  in  their  covariances  wsrs  observed 
because  of  tha  brevity  uf  the  run. 

8.  RILF- CONTAINED  ALIGNMENT  OF  AN  INERTIAL  GUIDANCE  SYSTEM 
3.1  Description  or  Problem 

As  the  accursoy  and  gsnsltlvlty  of  gyroscopsa  and  soceleroaettrs  lncreaas,  so  will  tha  importance  of  self- 
oontalned  alignment  of  inertial  navigators.  Thin  section  describes  the  application  of  tbs  Kalman  filter  to  the 
problam  of  estimating  the  orientation  of  an  inertial  aaneor  coordinate  frame  mint  only  the  signale  from  the 
gyroscopes  end  accelerometers.  The  vehicle  in  which  the  Instruments  art  located  is  undergoing  random,  t.ut 
limited,  trenelatlone  and  rotatlom,  such  as  a  launoh  vehicle  before  lift-off,  or  an  slroraft  being  loaded 
preparatory  to  take-off.  The  procedure  to  be  described  applies  liotb  to  sensors  stabilized  by  mane  of  gimbals 
and  to  sensors  mounted  directly  an  the  vehicle  body,  For  simplicity  it  is  msnused  that  one  gyro  input  tzis  and 
one  accelerometer  input  axle  is  along  each  of  three  mutually  orthogonal  diructions.  These  direction!  define 
the  sensor  coordinate  frame. 

At  the  time  that  the  fine  alignment  procedure  ooamencss,  the  sensor  coordinate  frame  will  have  a  email  vector 
misalignment  I  reletivs  to  soae  intended  inertlally- fixed  alignment  frame  (see  Figurr  12).  The  vector  i  is 
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a  random  variable  with  known  man  »i,d  oovarlanor  »l  t,  ,  determined  by  the  errors  In  non*  ooiraa  alignment 
soheme  that  haa  baon  aompleted  before  t„  and  that  need  not  cunnnrn  ua,  Thn  orlanlatlon  of  the  Intended  align¬ 
ment  t runo  la  anourataly  known  In  Inertial  xpuoe;  changea  In  orientation  of  the  sonnar  frame  relntlvj  to  ita 
actual  alignment  at  t0  are  alao  anourataly  known  (In  the  nano  of  body-mounted  aonanrn.  because  of  contlnuoua 
calculation  of  the  direction  coainc  matrix,  and,  In  the  caaa  of  a  gimballad  ayateoi,  beoauau  of  proolaolv  known 
torquea  applied  to  the  gyroa),  The  purpoeo  of  tha  Kalman  flltar  than  la  to  estimate, the  initial  mlnallgna t-'-nt 
vector  I  from  tha  accelerometer  raadlnga.  Thn  data  are  tha  vactora  £(t1 )  (1  -  1,2...  N. ) : 

8(1,)  -  -  Ktj>  +  V(tt)  ,  (3,1) 

where  I(tt)  la  thn  looal  gravity  vaotor  at  tha  alignment  alta  at  time  t,  >  t„  and  T(tt)  la  the  sum  of 
vehicle  aooeleration  and  aeoelarometar  noise.  In  nrdei  to  alnplify  tha  filter  equation*,  V(t()  la  takon  to 
be  aero  naan  nolle.  It  ahould  be  noted  that  |(tt)  la  known  in  any  given  inertial  coordinate  aynten  bernueo 
tha  geodetto  latitude,  longitude  and  altitudo  of  tha  alignment  alto  are  precisely  known  for  all  (,  ,  t0  <  t  q  tn  . 

3.3  Rcouraiva  Filter  for  tho  Problem 

If  one  denotaa  by  i~.  and  iij  the  filter's  aatlmate  of  a  Juat  before  and  Just  after  the  Incorporation  of 
the  data  Z(t,)  ,  then  the  data  Incorporation  equations  are 

=  6[  +  Kjzdj)  -2(tj)]  (3,3) 

P1  5  pi  -  ltlHlPi  (3.3) 

where 

(3.4) 

s  Kalman  flltar  matrix  at  time  tt  , 

Z(tt>  =  -g(t,)  -  Ktj)  a  aj  (3.8) 

*  eat i mated  observation  at  tj 

*  [I(tt>  « ]  (3.6) 

=  antlayanatrlo  matrix  oorrempondlng  to 

aroim  product  by  fttj) 

Rj  m  covariance  of  V(tj) 

w  ^(t^Taj)1)  .  (3.7) 

Hie  time  propagation  aquations  are  particularly  simple  in  Inertial  ipacs: 

*1  =  *l-i  !  K  =  0  O-D 

*PI  =  PIM  ■  pc*  *  eov(0  .  (3.8) 

Tha  obiarvatlon  matrix  H  ,  howavar,  to  time-varying  If  viewed  in  an  inertial  frame,  because  I(t)  la 
rotating  at  tha  earth's  rata: 

»(t,)  =  [l9(tj,  t0)li(t„)  .  (3.10) 

share  to(tj,t0)]  ia  a  matrix  repreientlng  the  eirth'a  rotation  from  t„  to  t4  .  To  be  apaoifie,  let  ua  oxpress 
all  vactora  and  astrlcas  In  an  Inertial  coordinate  system  having  one  axil  (u3)  along  tha  enrth'a  spin  axis  and 
tha  other  two  pointing  to  points  fixed  on  tha  celestial  aquator  (Fig.  13).  In  this  coordinate  frame,  with  ut 
directed  to  tha  vernal  equinox,  one  haa 

cos  &  -jin  0  0 

sin  6  corn  $  0  (3. 11) 

0  0  1 


'  0 

1  *3 

where 

0  -  (*i  - 10>  lfj*l 

In, I  =  ingnitudo  of  oerth' i  spin 
l  z  -lilainA. 

I,  =  -III  COB  K  COB  L* 

*3  =  -1*1  co«\  (In  L* 

III  =  nagnitude  of  local  gravitational  acceleration 
K  —  looal  geodetic  latitude 
L*  =  locel  hour  anile  of  Arles. 
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(3.  13) 

(3. 13) 

(3.  14) 
(3.  ID) 
(3.  IB) 


The  eeleotlon  of  elate  vertaMee  in  thle  alignment  problem  reeulte  In  a  tiae-varylng  obeervatlon  eatrix,  but 
trie  lei  tine  propaiatlon  equation!  for  the  etate  end  lta  covariance  matrix.  In  general,  euoh  a  oonpromiee  1* 
deilrable  In  applying  the  Kalaan  filter  beoauae 

(a)  the  oovarienoe  tine  propagation  equation  ie  a  aatrix  equation,  requiring  integration  or  the  calculation 
of  a  gtato  tranaltlon  entrix,  . 

(b)  the  observation  aatrix  H  ie  oalouiated  only  when  data  ia  received,  end  need  not  be  atored  between  data 
.tiaea,  .and 

(o)  no  nuaerloal  inaccuracy  la  introdunad  in  prnpainting  the  etate  or  lte  covariance  between  data  tinea. 

3.3  Batched  Filter  for  the  Prolilea 

The  reourelve  nature  of  the  Kalaan  flltar  lenda  ltaelf  to  an  alignaent  procedura  that  aay  have  to  be  tarnin- 

ated  at  any  tlae.  Such  la  the  caae  when  a  quick  reaction  capability  ia  needed,  aa  in  reaoua  launchea  or  when 

the  usual  alignaent  procedure  hue  felled  a  short  tine  before  launch.  At  the  other  extreme,  the  operation  of  a 
reourilve  filter  over  an  extended  period  of  tine  oan  result  In  numerical , end  geometric  dlffioultl*»1,"Jl, 
adequately  diacuaaad  elsewhere  In  thle  publication,  that  sake  its  continued  use  of  dubloua  value. 

If  adequate  tlae  li  available  to  collect,  say,  N  plecea  of  data  and  If  It  la  dea*  .  exaalne  these  data 
all  at  onoe  after  the  laat  ie  reoelved,  batch  prcaaaelng  formulas  are  aore  appropriate  than  recursive  ones.  In 

that  oaat  one  aay  rateable  the  data  ?'t()  ,  is  1,3, . .  .N  ,  into  a  single  data  vector 


calculate  the  eet lasted  obeervatlon*,  using  only  tha  eatiaatad  etate  at  t0  , 

-Ktj)  -  Kt,)  »«;’ 

-  Kt,)  * 

and  apply  the  Kalaan  Filter  equations  in  the  fora 
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than  tha  matrix  nultlpUeatlon*  ar*  eirrltd  out  It  la  round  th»t  no  wor*  than  3x3  matrices  »r»  Involved  for 
BSlll‘;:i(V,-V1>  "  ffc  Hjuj/fett,)  y  i(tj)  +  KtpxgJI  (3,23) 


hJ.^Nhh.i  -  ■  (3a4> 

Then  formulas  raduo*  to  a  weighted  lout  aquaria  eatlaatt,  u  expected11,  than  lj  -  0  and  (P})'1  ■  u  . 

1.4  Phyeloal  Aignirioanoe  and  Aocuraoy  st  Filtering 

Tha  physical  alwifioanoi  of  the  Llignment  filtering  l.i  aaaily  aian  In  Plgur*  13.  The  true  gravity  vantor 
at  tha  alignment  alte  rotate*  In  n  predetermined  none  about  the  earth1*  apin  aala.  Thl*  gravity  veotor,  a*  ***n 
through  thq  alaallgnod  inertial  aanaora,  la  estimated  to  h*  “  |(t)  +  I(t)i;4  ,  ihnro  S  ia  the  aatlnat* 
of  aiaallgnnrnt.  while  in  aotuallty  It  la  *lru#  «  I(t)  +  g(t)  x  V  .  »h*r*  I  ia  tha  true  misalignment.  Both 
I  .  and  atru.  rotate  at  the  asm*  rat*  a*  *  about  the  earth1*  apin  axla  and  sweep  out  parta  of  oonea  from 
t*  to  tN  .tha  function  of  tha  filter  la  to  bring  the**  tao  partial  oonaa  into  near  potnoldano*  by  bringing 
I  eloeor  to  V  .  In  the  oaae  of  tha  rapuralv*  fora,  an  adjuatnant  ia  aad*  at  each  data  point,  while  In  tha 
batch  fora  the  aotlmata  cone  piece  ia  adjuated  to  fit  the  data  (and  In  a  alnale  etep.  Thla  picture  of 

adjuetin*  a  portion  of  a  oone  to  fit  the  obaervatloni  explalna  »hy,  for  given  t,  ,  tt  .  tN  and  glvan 

P<ti)  ,  the  allgnaent  prooaaa  da  aoet  aaourate  at  t ho- equator  and  inopaeative  at  tha  poln:  the  oonlo  aurfaoe 
generated  by  (  In  a  given  tint  ia  gieeteat  at  tha  equator  and  nil  at  the  polaa.  Analytlaally,  the  obuerva- 
blllty  aatrlt  for  tho  problem  1*  juat  Equation  (3.21).  which  may  ha  wrlttan 

’tl(t,)x]“ 

H^,  -  lift,)*]  (S.2») 

,[|(tNl  * 3. 

and  thla  la  aaan  to  ha  alngular  If  »(t,)  =  l(e,)  «  ...  =  |<t„)  ,  etiioh  oooura  at  tha  pole*  of  the  earth. 

If  a  aaoaral  nttaur*  of  tha  aoauraoy  of  the  aliinaant  1*  daatrad,  on*  may  employ  tho  ratio  of  the  determinant 
of  P*  ,  to  the  determinant  of  Pj  .  Potter  and  Praaer”  have  ehown  that  thla  ratio  1*.  in  tha  praaant  oaae. 


1^,.1/KI  *  k)ll/k.1+HullpoX.J 


Proa  thla.  It  la  aaan  that  a  large  vnlu»  of  HN  jP^hJ  j  alii  reault  In  a  large  reduction  of  Initial  alignment 
error.  Ihla  aatrlx,  however,  la  ooaponed  of  N*  3xi  aub-natrloai.  of  which  the  (1, J )*“  aub-aatrix  lx 

HjP*hJ  »  (I(tt)  x]l(*XT)[l(tj)  »]'' 

*  p((Kt1)x*;)(»(tj)»«;)Ti  ,  (3.27) 

share  g  Indicate*  axpaotation.  If  the  earth  war*  not  rotating,  l(tj)  ■  I(t,)  =  I(t5)  for  0  <  1  ,  i  <  N  . 

In  thl*  out  an  initial  aiaallgnaant  tj  parallel  to  !<*,)  would  moke  all  the  aub-aatrloa*  uero.  Heno*  on* 
may  oonoluda,  aa  axpaotad,  that  the  aartb'a  rotation  la  nacaaaary  to  raaov*  Initial  aiaallgnaant*  about  the 
vertical.  Similarly,  or.*  ean  oonoluda  that  Initial  alaallgnaantj  about  axa*  noraal  to  *(tc)  are  reduced  even 
without  tha  earth'd  rotation. 

4.  UN1DINTIFICD  LANIIRARK  NAVIdAf ION 
4. 1  Introduction 

Onldentifiad  landaarh  navigation*'*"*’  la  an  orbital  navigation  technique  that  rail**  heavily  upon  the  reoureive 
properties  of  the  telaan  filter.  The  aathod  produoa*  laproveaont  of  vahiola  position  and  valoolty  Inforaation 
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using  only  passive,  on-board  measurements.  Slnoo  the  essential  information  required  le  the  dlrerilun  /row  the 
vnhldle  to  an  unidentified  gruuud  point,  relstlvo  to  lnartial  apaoe,  the  typlonl  ineitfumontatiun  comiirlaos  a 
landmark  telescope,  a  star  tracker,  und  a  computer,  It  is  not  necessary  to  store  an  extensive  list  of  landmark 
locations  and  idonttfleatlun  aids,  Moreover,  the  complete  elimination  of  t.h»  nstronaut'a  participation  is  olnu 
a  possibility,  buomisn  it  is  nsceasary  only  to  track  patterns  and  not  to  idontiry  them, 

The  mothods  available  fall  Into  tea  groups:  (1)  those  suoh  as  Reference  24,  In  whloh  the  landmark  location 
blasos  are  introduced  as  state  variables,  resulting  in  a  nlne-dlmnnslunul  state  vector:  and  (3)  those  similar 
to  Refsrsnoe  2(1,  In  elilflh  the  lsndmurk  biases  do  not  sppitar  explicitly  in  the  state  vector,  whloh  is  then  tho 
usual  alx-vsotor  of  poaltlon  and  velocity  deviations. 

The  first  typo,  comprising  what  will  ha  termed  the  one-sight  and  the  two-sight  methods  will  ho  dlsouaaod  here 
because  thoy  olesrly  Illustrate  the  role  of  the  Kalman  ftltnr,  A  discussion  or  both  types  of  itmthnds  is  given 
In  Reference  2d, 

Assuming  that  a  computer  on  the  orbiting  veil  la lu  in  nvailnblo  end  that  a  Kalman  filter  Is  omployori  to  process 
nsvtgstionnl  dats  from  other  than  landmarks,  the  following  additional  computations  must  be  performed  In  order 
to  Implement  the  unidentified  landmark  method  under  ouneldorstlon:  (1)  a  largin'  transition  matrix  of  the  statu 
veotor;  (21  the  estimated  value  of  the  lundmnrk  observation  minus  tlm  true  value:  (2)  tho  mcntmrcmoul  matrix, 
relating  the  landmark  observation  to  the  stute;  (4)  the  best  Initial  estimate  of  the  landmark's  position;  and 
(S)  the  initial  oavarlenoe  of  the  state  when  a  new  landmark  la  located.  These  five  required  calculations  will 
be  discussed  In  turn. 

4.1  nut*  Transition  Matrix 

The  nine  stats  vsrisblss  T  ,  f,  T  ,  representing  deviations  from  nominal  lh  position,  velocity,  and  land- 
nark  location,  have  a  stats  trsnsitlon  matrix. from  t,  to  t  given  by 


^v  0 

0  0, 

where  tha  four  upper  loft  sub-matrices  constitute  ths  usual  trror  propagation  matrix  for  vehicle  position  end 
velocity,  und  the  lower  right  sub-matrix  gives  ths  trsnsitlon  between  lendeierk  biases  T„  at  time  t0  and 
thrlr  value  T  it  time  t  .  If  III  In  a  planst-flxsd  coordinate  system,  than  t6||  is  ths  identity  matrix  I; 
If  T  lu  in  inertial  spans,  then 

*U  *  (ID  , 

• 

whsrs  (fl)  Is  ths  rotstionul  tranaformution  nipressntlng  planetary  rotation  from  time  t„  to  t  .  The  most 
convenient  coordinate  system  for  T  is  one  fixed  in  the  planet,  at  least  from  ths  point  or  view  of  tho  stats 
trsnsitlon  matrix  computation. 


4.3  Katiiaated  Observations 


Ths  ouserveticn  is  soma  function  of  vehicle  position  R  ,  vslooity  V  ,  and  landsiark  loostlon  L  determined 
by  the  Instrumentation  The  computer  oaloulates  the  observation  Y,  using  estimated  K  ,  V  ,  and  E  and  sub¬ 
tracts  it  from  the  actual  observation  Yr  supplied  by  ths  instruments  Ths  dlffsrsnas  YT-Y,  .  weighted  by 
ths  linear  filter  matrix,  Is  used  to  current  ths  deviations  T  ,  7  ,  T  ,  In  praotlos,  it  is  often  computation¬ 
ally  expedient  to  consider  the  "observation"  to  be  some  function  of  the  actual  instrument  rssdouts. 


In  Tsbls  IV  ths  first,  aolumn  glvss  ths  Instrument  readouts,  ths  second  column  gives  ths  computation  of  ths. 
observation  YT  In  terms  of  these  readouts,  and  ths  third  aolumn  glvss  the  computation  of  ths  observation  Y( 
from  wstlustsd  R  ,  V  ,  end  E  .  It  will  be  noticed  that  the  landmark  sensor  tnglss  T  (train  angle)  und  D 
(depression  angle)  may  be  processed  together  to  yield  ths  unit  veotor  measurement  p  ur  processed  separately 
to  five  two  scalar  masauramints  Also,  tho  calculation  of  (8)i  ,  alnot  it  does  not  oonoern  landmark  navigation 
exclusively,  is  not  given  in  detail. 


4.4  Measurement  Mxtricea 


The  third  calculation  required  for  the  linear  filter  is  t.he  matrix  M  relating  the  state  I  to  the  observa¬ 
tion  deviation,  y  .  In  the  present  cane,  l  includes  deviations  T  of  the  estimated  landmark  location  from 
ths  nominal  loostlon.  Tha  measurement  matrix  any  be  obtained  by  diirerentiatlon  of  the  estimated  observation 
funot lou, shown  In  colusn  3  of  Table  IV,  with  respect  to  S  ,  V  ,  E  .  The  results  for  the  two  choices  of  landmark 


observation  Y.  are  given  In  Table  V. 


4.9  Initial  Eatioats  of  Landau,  k  Poaltlon 


Proa  the  estimated  voololn  poaltlon  and  ths  observed  direction  in  Inertial  spsoo  from  vehicle  to  landmark, 
the  on-board  computer  must  extract  a  first  ostlaato  of  landmark  location.  Two  ways  of  doing  this  will  be 
described. 


w 


AX 
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On-itjM  mlthod 

If  the  moon  or  planet  In  assumed  ephurienl  of  radius  R(  near  the  landmark,  than  the  obnorvad  lint  at  sight 
fi  nay  b»  extrapolated  from  th«  vehicle  poiltlnn  li  to  where  it  Intersect*  the  ephefd.  Thin  le  the  estimated 
position  C  of  the  landnark,  It  la  oonputod  as 

t  s  K  ♦  pfi  ,  (4.3) 

there 

p  --  -H  -  [»{-»'  +  (!»•/»)*] w*  . 


The  aojor  innoouraoy  of  thle  method  ia  in  R.  .  Even  if  an  ellipaoldal  formula  la  uand  to  coniuto  RK  for 
the  earth,  or  a  table  atored,  the  terrain  on  which  the  landnark  in  aituatad  may  depart  from  thaae  appro* lmat lone 
by  a  etguifioaht  distance. 

Two-tight  method 

It  two  alghtinga  fi:  and  fi,  are  taken  at  tlinen  t,  and  t,  and  the  eetimated  vuhlole  poeltiona  it,  and 
It,  recorded,  then  the  on-board  oomputnr  may  ontlmete  thn  lonation  of  the  landmark  with  an  error  proportional 
to  the  average  nlghtlng  distance  tlmoa  the  instrumentation  angular  uncertainty.  In  thle  oaee,  Referenoo  24 
glvea  the  formulae  for  L  lot  a  non-rotatlni  planet.  In  vector  form,  they  are 

C,  =  ( (C(  +  C'0/a  ,  (4.3) 

where 

C,  ■  two-aight  eatlaate  of  L  at  t, 

Cj  -  R,  +  («,-«,)•  (A, 

C|'  »  R,  -  <R, 

and  .Or  fi{‘fi,  . 


If  the, planet  ia  rotating  with  eenatant  .angular  .valoaity  fl  ,  than,  an  ahown  In  Append!*  C,  It  la  neoaaaary  only 
to  replace  *,  by  (tTT'R,  and  fi,  by  ,  where  (flhi#  the  aatrla  repreatntlng  planatary  rotation  from 

t,  to  t,  ,  '■ 

Uae  of  the  two-alght  method  lntroduaea  a  alight  sequencing  problem  It  le  obvloue  from  the  geoaetry  thet 
the  two  elghte  upon  whloh  the  initial  landmark  estimate  le  beaed  ahould  be  well-eeperated,  preferably  with  P0° 
between  fit  nnd  fi,  ,  But  thn  linear  filter  oannot  proceie  readinge  until  thn  initial  landmark  eatlaate  le 
made.  Henui,  in  thla  method,  it  ie  neoeeeary  to  collect  all  the  reading!  on  a  given  landmark,  anient  two  w«U- 
eeparated  for  the  two-nlaht  eetluatlon,  nnd  thin  proceaa  the  reat  In  order.  If  twelve  T  and  D  reading!  end 
their  tinea  are  taken  in  the  protein,  then  about  3d  storage  looatlon*  are  required.  Thn  neauenoe  of  operation! 
le  ae  followai 

(1)  Store  R,  . 

(3)  Oolleot  and  atore  fil  and  tj  ,  1st . N  , 

(3)  Extrapolate  I,  to  5, 

(4)  Calculate  G,  from  Equation  (4.3),  uning  SN  and  fi N  in  plane  of  R,  ,  fi,  . 

(B)  Prooeee  the  date  fi,  ,  tt  for  bl . N-l  u  though  they  ooourred  in  reel  time.  The  result  ie 

Rn.,  and  ,  the  beet  estimates  at  tNa|  . 

4.1  Initial  Covariance  Matrix 

The  lnltialliatlnn  of  the  covariance  matrix  of  landmark  and  vehicle  errors  when  a  new  landmark  le  plaoed  can 


I 


be  a  orltlcal  on-board  computation,  aa  the  coaputer  runt  to  be  discussed  later  will  aho*.  The  extent  of  the 
on-board  nooputatlon  depend!  on  the  method  employed  to  eetimate  the  landmark  location  when  it  in  first  sighted. 
The  two  methods  Just  described  laid  to  different  oovarianos  matrices,  For  the  first,  the  one-eight  method,  the 
proper  covariance  le 
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>11  -  uprruT  + Wu[i-^T]uT*^L.j 

and 

U  *  l-fiF/fi'l  ,  P  B  E  -  R  ,  p  =  pip  <4.6) 

of  =  varlaitoe  of  lnitrumentatlon  angular  nolle 
cr{  =  varlano#  of  terrain  unoartalnty. 

(tor  tha  aaooml  aathod,  tlia  two-eight  method,  th»  proper  oovariaiioa  In  the  etuno  fora  »«  Equation  (4.4),  but 

ahara 

Pft  *  (APrr+8Pyr)T  ,  PY|  *  <tfrv+BPvv)T 

.  (4,7) 

P,,  a  APrfAT  +  APfyBT  +  8Prrv  +  BPyyB^  +  D,K,nf  4  0, K, K? 
and 

A  «  <i)(I 
»  «  (D^y 

D,  a  (1)^  [I  +##T]U, 

(4,8) 

.  0,  »  (1)/;,  [I  +VJ1U, 

A  ■ 

K,  •  (Dtri.Cl  “  T)  ■ 

In  tha  praoadlm,  p*  la  written  for  (D)'1^  ,  and  tha  aubaorlpti  1  and  3  rafar  to  the  tinea  of  tha  flrat 
and  laab  alihtlngn.  Tlia  quantitlaa  I  ,  4> .  fi  ,  of  ,  U  ,  and  (D)  havo  tha  a  ana  naanlnia  an  pravloualy.  Note 
that  of  ,  tha  varlanca  of  terrain  roughnaaa,  doaa  not  appaar  in  tha  aaoond  nathod,  aa  to  be  aapaotad,  Tha 
darlvationa  of  thaaa  Initial  oovurianoea  are  rather  involved  and  alii  not  ba  praaantad  hara. 

4.7  Coaputar  1  imitation 

laoauaa  tha  ana-alght  nathod  appaars  to  raquira  laaa  oonputatlon  than  other  nathoda,  a  proiraa  van  oon- 
atruotad'4  to  try  it  out,  Tha  proiran  oaloulatad  tha  oovarlanoa  of  tho  nlna-varlabla  atata  by  tha  linear  filter 
aouatlona.  It  alnulatad  vhlta-noiia  on  the  raadlma  and  tha  terrain  error  in  eatlaatlni  the  iandmarke.  Tha 
error  in  tha  optlnal  aatinata  of  tha  atata  van  oaloulatad  and  oonpared  to  tha  oovarlanoa  aatrlx  aa  an  approximate 
oheok. 

The  flrat  elinlfioant  raault  obtained  la  that  the  one- light  aathod  data  not  work  union  the  oovarlanoa  aatrlx 
in  properly  lnitlaliaed  for  aaoh  new  landmark.  Thla  raault  van  obtained  In  eavafal  computer  rune,  n  typical 
pair  of  ehloh  la  ahovn  In  Pliuraa  14  and  18.  Tha  conditions  for  thaoa  runn  are  lilted  in  Table  VI. 

Pleura  14  ahoma  tha  roduotion  In  tha  aannitudo  of  tha  aotual  poaltion  error  and  tha  aquara  root  of  tha  trace 
of  tha  poaltion  oovarlanoa  when  tha  oovarlanoo  matrix  van  lnitlaliaed  for  aaoh  landmark  aa: 


v  9  *  8  . 


oov(f)  *  Pjy 


ahara  p  ,  p  ,  P  are  tha  3«3  aub-matrloaa  of  tha  vahlola  poaltion  and  veloolty  at  tha  time  of  alihtlni 
tha  landmark,  and  S  la  a  dlaiunal  aatrlx  of  alamenta  aaoh  equal  to  tha  traoa  of  P„  Although  thla  lnltlal- 
1 nation  procedure  aaama  oonaarvatlva,  tha  ranulta  are  dlaappointlm;  while  the  oovarlanoa  matrix  gradually 
apprnaahaa  aaro,  tha  aotual  error,  whloh  It  uuppoaedly  rapraaanta.  goaa  to  Infinity. 

In  oontraat,  Pigura  IS  nhova  tho  Identical  computer  run  (aama  instrument  nolss,  aame  terrain  error,  ato. ), 
but  with  tha  oovarlanoa  eatrU  lnitlaliaed  tu  given  by  Equations  (4.4),  (4.  S)  and  (4.8).  The  aotual  error  hara 
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U  In 'such  better  agreement  with  the  covariance  matrix,  rrom  these  and  other  almllar  palra  of  runs,  It  Is 
concluded  that  the  covariance  of  the  lnndmurk  error  and  arena  correlation  of  landmark  and  vehicle  errors  hunt 
be  calculated  correctly  at  each  new  landmark  for  the  one-sight.  method. 

The  computer  runn  Just  dismissed  are  for  a  lunar  satellite.  Figure  Id  show*  the  renulta  of  the  one-sight 
method  for  an  earth  eatellltn.  Sevan  lendmurk*  tire  observed,  all  on  the  dayaldo.  About  alx  palra  uf  rendlnga 
(T  and  D),  apaced  1.3  second*  apart,  are  taken  on  ennh  landmark.  This  measurement  schedule  la  judged  to  be 
within  the  capeblllty  of  a  human  operator,  cloud  cover  and  other  dutloa  allowing. 

With  the  run  ahown  In  Figure  10  a»  a  nominal  uaee,  the  fallowing  parametera  were  parturbod'  seimor  nolia, 
orbital  altitude  (e  «  01,  terrain  error.  The  reeulte  are  shown  in  P'lguree  17 - 10.  Theea  curves  represent  the 
square  root  of  the  trace  of  the  oovarlntioe  matrix  Immediately  after,  and  one-half  hour  after,  the  lent  landmark 
observation. 


5.  CONI' l, till  1N1I  REMAKKS 

The  facility  with  which  the  Kalman  filler  dispatched  thu  complicated  entlmatlon  prnblesis  described  In 
Beotlune  3,  3  and  4  chould  not  obscure  two  curious  difficulties  In  its  use,  of  which  only  a  very  hrluf  discus¬ 
sion  will  be  given  here: 

(1)  Tho  need  to  llnearlme  the  problem  without  loan  of  accuraoy. 

(31  The  pretence  of  computational  dlfflcultiia. 

ft.l  Nonlinearity 

The  linearity  problem  enter*,  generally,  through  the  approximation  mad*  In  the  atate  tranaltion  matrix  or 
that  made  In  the  obeervation  matrix.  Thai*  two  matrloaa  reprexent  linear  approximation*  to  what  may  be  nonlinear 
relatloni. 

• 

In  the  aaa*  of  orbital  navigation,  tha  mensurament  nonlinearity  often  produces  a  more  aerioue  error  than  doer 
the  state  traneitlon  matrix  approximation.  This  la  usually  trua  for  radar  range  readings1,  Tha  problem  of 
measurement  nonlinearity  may  be  overcame  In  an  trror  analysis,  such  am  described  in  Section  11,  by  using  data 
simulated  from  t  linear  model,  rether  than  reel  data  or  data  generated  by  i  nonlinear  model,  An  error  analysis 
thue  oonitruoted  will  not  have  nonlinearity  error*,  but  will  not  be  a  reliable  guide  to  the  nonlinearity  effects 
■to  be 'encountered  In  a  program  that  process**  real  data, 

In  the  sue  of  Inertial  ayatam  alignment,  Section  3',  nonlinearity  osn  enter  only  In  the  measurement  matrix, 
alno*  the  state  transition  matrix  la  oxaotly  the  Identity.  The  extant  of  the  nonlinearity  error  depends  an  the 
111*  of  the  estimate*  I  . 

Nonlinearity  error*  con  be  expected  to  occur  in  unidentified  landmark  navigation,  both  because  of  the  measure- 
lent  model  and  biaaua*  of  the  stats  equation.  The  simulations  described  in  Section  4.  however,  were  based  on  a 
nonlinear  measurement  prooees.  For  this  reieon  It  would  teem  that  measurement  nonlinearity  doss  not  seriously 
affect  the  landmark  navigation  mathoda  of  Section  4. 

t.i  Cosgmtatlonal  Dtrricultlai 

All  three  applications  discussed  in  this  chapter  are  susceptible  to  the  numerical  inaccuracies  caused  by  a 
finite  aamputer  word  length.  These  enter  In  many  ways  and  have  varied  mechanieme  end  cures11'*1,  the  dleoueelon 
of  which  li  taken  up  elsewhere  In  thlm  publication.  Only  two  areom  of  difficulty,  whioh  have  appeared  in  the 
simulation  program*  of  Seotion*  3  and  4  of  this  chapter,  will  be  mentioned.  They  ere  tn*  calculation  of  the 
covariance  matrix  . 

P*  a  P'  -  KHP’  , 

and  the  calculation  of  the  matrix  product 

ph’  . 

The  first  of  them*  lead*  to  an  Inaccurate  result  If  P'  end  KHP'  are  almost  equal.  Thin  Is  because  the 
magnitude  of  the  error  (whioh  Is  determined  by  the  number  of  digits  employed  in  the  computer),  divided  by  the 
magnitude  of  the  answer  (which  say  be  extremely  email  If  P'  and  KHP'  are  almost  equal),  yields  a'  Urge 
fractional  error  in  the  new  P*  matrix.  This  situation  arises,  as  It  did  In  the  simulation*  of  Seotion  3, 
when  a  sense  of  highly  accurate  range  readings  era  taken  by  a  ground  rnder  on  a  sateilita  whose  position 
unnertalnty  In  tpproauhlng  the  station  la  vary  large.  The  initially  large  covariance  matrix  la  raduaed  by  a 
merles  of  subtraction*  of  the  form  -KHP  to  one  that  Is  imaller  by  several  ordtra  of  sagnltude,  at  leant  in 
tb*  direction  of  the  line  of  eight  from  the  station  to  tha  vehiola.  If  thase  orders  of  aagnilude  equal  or 
exaesd  the  number  of  digits  In  the  oomputer  word,  all  numerical  significance  it  loot, 
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APPENDIX  A 

Derivation  of  Equation  (2.7) 

If  the  linear  filter  K  la  uaad  to  update  me  atate  tatleate  i"  ,  what  la  the  oovarlanoe  P*  of  the  error 
in  the  reaulting  eatlaate,  i*  ?  Let 

8+  =  8*  +  x(*-hJ')  , 

where 

a  =  Hx  +  v 

E(V)  =  0 

E(vvt)  -  R  -  known 

Kx-8*)vT  =  Ev(x-r>r  =  0  . 

A  dlreot  calculation  of  P*  Iron  ita  definition  ilvee 
P*  =  l(x-8*)<i-SV 

=  l[x  -  8’  -K(P-H8")]  [x- 1*  - K(a  -H8")jt 
=  rte'  -KHe"  -Kv)te‘  -KHe*-KvjT 
=  Kt(I -XHe)e*  -Kv]  id  -KH)e*  -Kv]T 

s  (t  -KH)([(e')(e")T](I  -  KH)T  '  tt[(v)(v)TKT]  -  Xl[(v)(e')’)  (I  -  Oi)T  -  (I -KH)Et(e') (v)T]KT 
=  (I  -  KH)P"  (I  -  KH)t  +  Xl«r  , 
where  e  haa  been  uaed  for  a  -  8  and  P  for  E(eeT)  . 


APPENDIX  I 

Itate  Trane  it  ion  Matrix  for  Air  Oran.  Brevity  and  Oblateneaa  Coeff icieeta 


Thla  Appendix  derlvea  the  differential  equatlona  far  vehicle  poeltloe  and  velocity  errore  produced  by  ooaatant 
errora  lu  tbr  drop  paraaeter.  oblateneaa  coetficienta  and  (ravitatiooal  parameter  of  an  earth  aatellite. 


Tha  vehicle  poaltlon  R  and  velocity  V  are  liven  by 


_d 

dt 


epere 


i 

V 

V 

■  - 

p„  ♦  ?0I  V  C_ 

(».» 


poe  •=  -3Uo,/3* 


6  =  io4VVe'‘ll(***»> 


P,  ,  k0  .  Na  -  drag  oonataata 


raalua  of  earth  correapondlng  to  C- 


D, 


drag  paraaeter 


The  typical  quantity  5Folo  in  the  above  la 

^  ■  £$"{ -[i-w.™ 


there 


end 


de 


^<*>1r  +  R  M  Rl  , 
J  da  I 


2n  +  1 


dPcM  (»)  _  an  f  1 
da  n  + 1 


dP  (a) 

e-d_+Pn(e> 


dP„ 


I  n  ^P»- 1  (a) 
J  n  +  1  da 


t  -  0  ,  —1=0 


,  dP, 

F,  *  a  ,  — L  -  1  . 

1  da 


equation  (P.4)  wilt  yield  the  tranaltlon  aetrix  relating  poaition  and  velocity  errora  to  the  noraalked  blaeoa 
in  .  Ifi  ,  SO,  ,  Sck  ,  Sc  j  and  .  The  ohoict  of  i  ,  J  ,  It ,  1  dependa  on  whioh  oblataneea  ooefflolenta 

art  of  intereit. 


APPEND  IX  C 

T*o-aiyht  Landaark  Location  for  a  Rotating  Planet 


The  problea  la  to  obtain  an  aetlaate  C,  of  landaark  poaition  at  tlae  t,  given  obeervatlon  /t,  and  vthlolt 
poaition  Rj  at  t,  ,  and  /3,  ,  R,  at  tlae  t,  ,  , 

The  landaark  poaition  at  t ,  any  be  eat  lotted  aa 

C,  =  R,  +p,S »  .  (C.l) 


where  Pt  ie  unknown.  The  landaark  location  at  tlae  tt  any  be  eatiaated  aa 

E,  =  R,  +  p,p ,  , 


(C.  2) 


where  pt  la  unknown.  Since  L;  *  (fi)L,  ,  where  (0)  la  the  rotational  tranaforaation  of  the  planet  froa  t, 
to  1,  ,  the  laat  equ  tloo  beooaet 


l,  .  (nr1*,  . 


(C.3) 


Iquatlona  (C.l)  and  (C.3)  are  alx  aoalar  equetlone  in  five  unknotnt,  and  heooe  too  aolutiuoa,  L[  and  L,"  , 
aay  be  obtained  by  atraightforward  algebra: 


where 


E;  =  r,  ♦  (Rj-R.j-W.^-^Vd-c*)  . 
E"  •>  if-dJ-R^-^-C^^/d-C')  . 

i?  »  W'i, ,  V  =  (nr'V 
c  =  flt-X  . 


(C.  4) 
(C.  8). 

(0.  8) 


Dieae  aolutinna  are  not  identical  beoauae  of  nulee  on  the  date  and  5,  .  Their  average  la  a  better 
eetlaate  than  either  one  alone.  Thua, 


L,  =  (L;  i  f',V2  . 


(C.  7) 


It  te  ae*n  that  the  only  effect  of  the  planet's  rotation  la  to  introduce  (ST/1  in  front  of  R.  and  p,  . 


TABLE  I 


Obiirvntion  Rttricei 


Oburvai  ion 


variablts 

*  .  y  .  *  fio 

A«,  An,  Ah  (-p0  i,  -p„*n,  -p„ ♦  fi) 


x  ,  y  ,  i  Uv-v0)  -  tf-*ia)-£apB]/pa 

x  .  y  ,  i  Pa/Pa 

A* ,  An,  Ah  (6  •<!)„,  n-G>0, 


x,  y,  x  (S  cox  A  -  fi  nln  A) /A,  oo»  L 


Obitrvation  latrijc 


A*  *  An,  Ah  {«(K,  p*  -  ?„//>*„)  +  ftM.Pn  +  a^in)  +  Pox&V>nKl  +  <np„  +  Sp.l/RoPjn1} 


E  x,  y,  x  (-iiinAilnE  -  n cos  A  sin E  +  fioo»E)/p0 

A«  .  An  ,  Ah  (tp./R,,  +  fipn/Ra  -  h  +  hh/Pa'l/P'i 

\  AC  1 

*,  X,  y,  t  -KR1h/R1/(R*-r£h) 

K,  1//(R’  -rJn) 

1 

Ah,  1^(R* -»£,,) 

At,  1 

x  ,  y  ,  x  -rj/R 

,  <9,  (0,0, -1)  (or  IMl  on  $fit  tm 

0,  .  0i  ei  -  i  tor  W#  on  XYZ  axis 

S,  I//(R* -R«m) 

*,  1 


6,  ,  0,.  «,  (0,1,0)  for  IWJ  on  f?)?  axis 

8l  .  0,  .  8t  f)  for  IMU  on  ATE  axil 
h,  1//(RJ -rIh) 


i  *w  ■  /  *  '-  ’  i<  *  ***  »«*■  V 
*  -  ■  ’a  *  •  .  fc  b  *  I 


»•  j  *x  ..  •  >.  *  .. **  *  m  .  « - 

<V  *./  V1 


fv VST-V** 
■  ..  ■■  «vW\" 


•.*  ■  »  V",'  S’  •  "I 

’  "  ‘  *  *  »  *  -  *  to 

•  ■  '  ,  1  •  "  -  *  to  * 

*  to  ’  to  »  to  •  fc  "  to  »  .  *  m 

:  V  WV  V.vW 

*-r*«*Hto*«Ttoto,®toito( 


Obstrvation 


Statt 

variablti 


Obttrvatinn  aatri* 


•  ~  +  PnW*'  ■  {or  IMU  an  XVZ  exes 

(l*  -P»(P%n^''  ~PtfPt^')  •  IMU  on  £vl  »*»* 


-4  »  I//S-  ,  IMU  on  XVZ  axes 
(0,  -Pgj/V 8'.  p„/S').  IMU  on  axes 

2 
1 

f«v5" 

£  +  Pi,(  i)/S"  .  IMU  on  XVZ  1X11 

(1.  -PLfPi,*/5"'  “4*4(/s"'-  imu  on  «• 
1 
1 

£/Jh" 

-4  *  |//$"  ,  IMU  on  XVZ  mu 

(o.  Plr/^"^'  **)  UB  2'Tll  MU 


NOTS:  Auxiliary 

auentltlea  (or  Table  I  art  ilvsr,  In  Piauree 

1-5  and  m  follow*: 

>s 

R 

= 

|R| 

- 

distance  fro*  center  of  earth 

to  horiaon 

' 

*0 

X 

a»  s  rq 

I'*.  .  ■ 

£ 

I 

S 

aniular  valoolty  ot  earth 

4f 

r 

14 1 

4e 

r 

n'4 

4 

s 

= 

?•*. 

o,  «  4  +  (9-?q)  •44/4  - 

4t 

.  »" 

*  _ 

, 

°« 

X 

JE 

-  (V-4)/p„ 

S' 

~ 

p!(  *  p*  i) 

sa 

K. 

X 

tan  A.0/Rn  P«. 

4 

X 

4/I41 

List  of  suto  Variables 
(Excluding  Bisses) 


vohiole  X  Inertial  position  error 

vehicle  Y  inertial  position  orror 

vehicle  Z  Inertial  position  error 

vehicle  inertial  volooity  error  alone  X  axle 

vehicle  inertial  volocit.v  error  along  Y  axle 

vehicle  inertial  velocity  error  along  7,  axis 

gyro  1  angular  error,  due  to  drift 

gyro  2  angular  error,  due  to  drift 

gyro  3  angular  error,  due  to  drift 

gyro  1  random  drift  rate,  tine  correlated 

gyro  a  random  drift  rata,  tiae  correlated 

gyro  3  random  drift  rate,  time  correlated 

gyro  1  drift  rate  bias 

gyro  3  drift  rate  bias 

gyro  3  drift  rate  bias 

horiaon  phenomenological  deviation  affeotlng  altitude 
horison  phenoseno logical  deviation  affeotlng  vertical 
horlton  phenosenologicsl  deviation  affeotlng  vertical 
borlson  sensor  tins  correlated  error  in 
horizon  sensor  ties  oorrelsted  error  in  $, 
horizon  sensor  ties  correlated  error  in 
star  tracker  time  correlated  error  in  TR( 
star  tracker  tins  correlated  error  in  Hig 
landmark  sensor  time  correlated  error  in  TRL. 
landmark  sensor  time  correlated  error  in  It,L 
bias  in  earth’s  gravity,  n 

biases  in  sonal  harmonics  of  gravitational  potential, 
3  <  14(1)  ,  14(2)  ,  14(3)  ,  N(4) 

bias  in  drag  parameter,  D, 


TABLE  III 

Lint  of  Elan  State  Variablce 

(round  radar  itillon  location  arror,  easterly 
(round  radar  atatlon  looation  error,  northerly' 

(round  radar  atatlon  looation  error,  vertical 

(round  radar  range  bias 

(round  radar  ranee  rate  bias 

(round  radar  azimuth  bias 

ground  radar  elevation  bias 

horlaon  tracker  atadioetric  angle  bias 

horizon  tracker  vertical  an(li  blaa  on  l  aria 

horizon  traokar  vartloal  angle  Ulan  on  v  axia 

horizon  deviation  bias,  affecting  etadlaetrlc  altitude 

atar-lMU  train  angle  blaa 

atar-IMU  elevation  anil*  bin  ' 

landaark-IMU  trsln  anils  bias 

landmark- HU  alavation  anil*  bite 

radar  altiaatar  bias 


•\V. V.v.V.*-' 
■V V'v-' Vvl 

»  ,•  r  V 

1 

'  e  * \  \  w  b1,  I*,  W 

■V  -.1 


,**  Vv^'.VvV 
V  •.  S  v  O 

'.V'.-Ct*-'’ 

,*  s’  tfV  v  • : 


TABLE  IT 

Obaervatlona  Tor  Unidentified  Undaarh  Navigation 


Inetrunent 

readout 

True  observation,  Y, 

Star  traoksr 

<Y)t  =  (8)  , 

■  si 

•her* 

(1  =  1,3,31 

(8)  v  (8, , , 8,, ,  ll3) (Sv, , 8y| , Sv,)" 1 

Syi  a  (oo«6[  coaa^.co*  ainct^.ein  8j)T ,  i  -  1,3,3 

Landaark  aenaor 

Vector  observation: 

T  ,  D 

<T  ■  <8>*(P,1  . 

■hart 

/fl¥  =  (ooaO  ooaT,  ooaD  ainT,  ilnD)T 

Landaark  aanaor 

Scalar  obaervatlona: 

T 

Yt  =  T 

D 

rT  >  d 

EtUnatld  observation, 


(Y),  =  (8), 


,  C-K 

*•  '  TOT 


""  /r  Bv  2 


(£-!>•*, 
.,  (C-S1B, 
ic  -  m 


OjS,  a  amiauth  and  alavation  of  itn  atar  relative  to  vehicla  frame,  v 

Stl  a  unit  aoluan  vector  of  1th  atar  relative  to  inertial  apnea 

(B)  *  aatrlx  tranatoraation  from  vehicle  fraae  to  inertial  apace  =  ,d 

T  -  train  anila  of  landaark,  aaaaured  about  vahtola  8,  axia 

D  a  deprenelon  angle  of  landaark,  aeazured  noraal  to  vehiola  8,8,  plan* 

(S),  =  (8)  eatlaated 

T  -  tranepoae.  ehen  used  as  a  nuperacrlpt 


dj rbhsxzbzxx  &&aE?3. 


TABM1.  V 

Reaaureiaent  Matrices  for  Unidentified  Landaark  Neviaation 


Minturmnt  matrix 


Oburvation 

*  a 

Scalar  ubaorvationB; 

h 

=  tan  1 - i 

1. 

-l 

i  aln  1  — -* 

P 

,  5, 

s  i  k  a 


NOTES:  /}  =  L  -  R  ,  p  -  P/p  ,  p  -  |^| 

Sjfljfij  =  unit  veotora  ilon*  vahiolt  aiaa  1,2,3 

C  =  eet lusted  landmark  location  vector 

®  =  eatlaatad  vehicle  poeition  vector 

Pi‘Pt>Pi  3  oouponente  of  p  alone  vehlole  axei  j, 2, 3 
0  *  (0,0,0) 


TABLE  VI 

Conditions  for  Computer  Runs  of  Ftiursa  14  end  IB 


Orbit:  lOO-naurioal-aile  ciroular  lunar  orbit 


Gravitational  parameter 

■eai-aajor  aria 

Booentriolty 

Inclination  to  lunar  equator 
Start  tine,  t0 


1,7313  »  lO'TtVaeo* 
1038. 5  nautical  ml lee 
0,0 

01  dei 

0,0  hr 


Maaauraaanti: 'Unit  veotor  froa  vehlole  to  landaark 


Tins  of  first  Maaurenent 

Ties  between  measureaente 
Tlae  of  last  ae  inurement 
Landmark  aeneor  ehlte- nolle 
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CHAPTER  16 

SECTION  I  -  APPLICATION  OE  KALMAN  FILTERING  FOR  THE 
ALIGNMENT  OF  CARRIER  AIRCRAFT 
INERTIAL  NAVIGATION  SYSTEMS 

Junta  T.Kouba 


1.  INTRODUCTION 

Because  mlenlons  generally  flown  by  military  aircraft  require  covertnees  In  a  hostile  environment,  the  need  for 
a  aalf-oontalnad  passive  navigation  system  has  long  been  recognized.  Being  self-contained  and  passive  means 
rsspeot Ively  that  the  syatem  does  not  have  to  rely  on  any  external  equipment  euoh  as  LORAN,  OeiegR,  etc. ,  nor  radiate 
to  perform  the  navigation  function,  Since  oovortnaea  la  not  necessarily  required  for  all  phases  of  a  mission,  tha 
military  navigation  ayateta  generally  comprises  of  a  multitude  of  subsystems,  including  active  and  non-eslf-oontained 
element*,  so  that  maximum  use  in  made  of  all  available  Information.  Howsvtr  the  eyetem  invariably  has  and  requlrea 
the  Inherent  oapablllty  of  performing  the  navigation  function  in  a  aelf-sontalned,  pnanive  manner. 

Thl*  requirement  ii  emphatic  for  aircraft  operating  from  an  aircraft  carrier.  The  military  functions  performed 
by  these  ilrbraft  require  flight  over  water  for  extended  periods  of  time  without  the  benefit  of  external  alda  to 
navigation  and  often  in  a  hostile  environment.  Additionally  these  aircraft  are  required  to  return  to  the  alroraft 
carrier,  which  may  bw  oonowalwd  by  weather  and  eleotronagnetio  ailenot.  Without  a  self-contained,  paseive  naviga¬ 
tion  eyetem  these  novel  taotloe  would  bw  Impossible, 

Tha  only  navigation  ayatem  satisfying  these  requirement!  1*  the  Inertial  navigation  system.  It  provide!  in  a 
ielf-oontalned,  paseive  manner  all  the  required  orulee  navigation  information.  It  is,  however,  recognized  that 
certain  functions  to  be  performed  will  require  contact  In  one  form  or  another  with  tne  outside  world,  so  that  the 
inertial  navigator  cannot  be  the  only  element  of  the  navigation  eyetem. 

Minot  thm  performance  of  an  inertial  navigator  is  highly  correlated  with  the  initialization  aoouraoy,  it  la 
Imperative  that  a  highly  rollgbl*  and  soourate  initialization  process  be  devised.  The  recognition  of  this  problem 
tnd  the  need  for  its  nolutlon  an  applied  to  carrier  alroraft  has,  in  the  past  tew  years,  led  to  Intensive  research 
and  analysis  to  resolve  the  multitude  of  operational  and  performance  problems  associated  with  it.  The  following 
Motions  dltcuee  and  analyze  the  oarrler  aircraft  initialization  process  and  logically  develop  the  requirements. 
Because  of  the  classified  nature  of  tha  problasi,  the  material  will  be  limited  to  a  Qualitative  description  of  the 
prooeeeee  involved.  The  actual  quantitative  performance  requirements  end  the  detrlls  of  the  solutions  are  omitted. 

Section  3  ii  a  brief  review  of  the  eesentlal  feature!  of  inertial  navigation  and  lnaludes  a  generalized  mechani¬ 
zation  diagram  for  four  different  local  level  mechanisation!.  An  eteential  ingredient  in  the  design  of  a  Kalman 
filter  ii  the  error  model  of  the  eyetem  being  controlled.  To  this  end  Section  3  present!  a  generalized  error  model 
for  the  four  nechanlzatlone  described  in  Station  3.  Section  4  define!  the  Initialization  prooete  and  Sactlon* 

S,  t,  and  7  dlzcuta  the  multitude  of  problems  encountered  in  oarrler  deck,  oatapult,  end  in-flight  alignment. 

Finally  tha  oheptsr  concludes  by  illustrating  the  varlou*  features  of  a  Kalman  filter  for  oarrler  deck  alignment. 

t.  THI  INERTIAL  NAVIGATION  SYSTEM 

The  eeeential  elements  of  the  inertial  navigation  eyetem  are  the  lnetrucent  clueter  (platform)  (ooneletlng  of 
gyros  and  aooelaroeietera)  that  is  glmbaled  to  the  airframe  and  a  digital  computer.  The  inatrument  duster’  e 
geographic  orientation  is  controlled  by  torquing  eignale  supplied  by  the  computer,  which  in  turn  acoeptn  the 
outputs  of  the  auoelerometeri  and  oomputea  velocity  tnd  poeltion. 

More  specifically  oonsider  a  right-handed  orthogonal  coordinate  eyatem  (x,  y,  z)  azeooitted  with,  and  rigidly 
attaahed  to,  the  instrument  clueter,  The  accelerometer*  ted  gyros  are  arranged  ao  that 

(1)  the  positive  eenzitive  axes  of  the  accelerometers  coincide  with  the  x  ,  y  ,  z  axes, 

(11)  torquing  signal*  applied  to  the  gyroe  will  selectively  product  angultr  ratae  of  the  platform  about  the 
x  .  y  ,  i  axes, 

For  aircraft  inertial  navigation  ayatema  a  local-level  mechanization  is  generally  employed.  In  thle  mechaniza¬ 
tion  the  platform  ii  controlled,  Ideally,  via  ltt'gyroe  so  that  its  z  axlz  le  always  oollinear  with  the  local 
perpendicular  of  the  reference  geoid,  Independent  of  the  motion  of  the  alroraft,  There  ar  four  different  types 
of  local-level  mechanizations  that  can  be  considered.  One  of  these,  celled  ncrth-polntinz,  le  euoh  that  the  y 
axle  of  the  platform  Ideally  always  points  north  (x  axle  points  east  end  z  up).  For  the  remaining  three  mechaniza¬ 
tions,  called  wander  azimuth,  the  y  axle  is  not  constrained  to  remain  north  but  le  permitted  to  "winder"  at  a 
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controlled  rate  relative  to  north.  The  computer  In  turn  oomputo*  the  wander  angle  by  caeonttally  (not  dirootly) 
integrating  thn  wander  angle  rate.  Aotually  the  wander  angle,  latitude,  and  longitude  ere  all  Implicitly  computed 
by  solving  a  net  df  differential  equations  for  a  cot  of  direction  cosines. 


comparatively  tin*  north-pdntinu  mechanization  la  considerably  simpler  than  the  wander  aalmuth  nicolmn  lent  lone, 
However  It  does  have  the  disadvantage  of  not  having  a  polar  capability.  Thle  results  from  the  fact  that,  as  the 
navigation  system  approaches  thp  polo,  the  azimuth  gyro  (z  gyro)  tnrquing  rate  requirud  to  maintain  the  platform 
north-pointing  becomes  excessively  large,  Such  is  not  the  ease  for  the  wander  aselmuth  mechanisation  since  the 
platform  la  not  constrained  geographically. 


In  the  sequel  It  will  be  shown  that  the  wondor  azimuth  mechanization  Is  particularly  advantageous  for  the  solution 
of  tho  alignment  problem  while  the  alroroft  In  on  tho  flight  deok  of  the  airornft  carrier.  This  rcaulte  principally 
because  tho  wander  azimuth  platform  can  Initially  be  at  any  angle  relative  to  north  and  the  computer's  wander  angle 
adjusted  to  agree  with  It. 


A  complete,  detailed  derivation  of  these  four  local-lcvol  mechanizations  cun  be  found  elsewhere'  For  future 
reference  Figure  1  dtagrammatlcally  presents  a  generalized  iieehunl nation  block  diagram  for  local-level  froo-lnort lnl 
navigation  systems.  Although  It  theoretically  represents  all  four  local-level  mechanizations,  In  artuul  practice 
many  variations  are  useil,  This  la  especially  true  for  the  north-pointing  mechanization  wherein  many  simplifications 
arise  and,  instead  of  computing  direction  cosines,  latitude  and  longitude  are  obtained  directly,  For  simplicity 
the  vertical  channel  mechanization  hai  been  omitted,  Table  I  Uiti  ths  definitions  of  the  symbols  used  in  Figure 
1,  end  Teblo  II  Uste  the  vertical  platform  angular  rates  for  the  vartoue  mechanizations,  It  should  bo  noticed 
that  for  any  of  the  wander  azimuth  maehinlzatlona  tha  atplioit  reduction  of  the  direction  ooslnee  to  latitude, 
longitude,  and  wander  angle  le  required  for  display  purpose!  only. 


Tha  next  section  presents  in  error  model  (or  these  meohaniznlinne, 


3.  THE)  INERTIAL  ERROR  MODEL 


The  object  of  tho  initialization  proceea  la  to  remove,  insofar  as  poasiblo,  tha  deviation  of  the  actual  aystem 
from  an  Ideal,  arror-free  aystem.  In  general  the  estimation  of  the  deviation  la  made  by  compering  (subtracting) 
a  aat  of  reference  variables  with  (from)  a  act  of  commensurate  variables  computed  by  the  eotuel  eyutum  and  Inferring 
from  theeo  all  deviations  of  Interest.  The  inference  process  requires  a  model  relating  tha  quantities  that  are 
observed  with  all  quantltlaa  of  lntaraat, 


Adequate  eetlmate  and  control  of  the  Initialization  process  must  take  Into  account  buth  the  deviation  of 
raferanca  variables  and  the  eyetem  variable*  from  the  error-freo  cyetew  variable*.  Thu*  a  naoesaary  requirement 
far  the  design  of  «n  alignment  tsohuique  le  a  model  of  the  error  propagations  of  both  the  inertial  system  and  tha 
raftrenoa  system,  l.e.  the  differential  and  algebraic  aquation*  governing  tho  deviation*  of  the  actual  aystem* 
from  the  ideal,  error-free  systems. 


The  reference  system  will  vary,  depending  upon  what  Is  available  and  desirable  to  uee  et  the  time  the  initializa¬ 
tion  prooaaa  la  being  invoked.  For  example,  if  the  Initialization  process  le  carried  out  while  the  ilroraft  Is  an 
the  ground,  no  external  Information  la  required  except  Initial  position,  and  tha  Initialisation  process  la  carried 
out  la  a  completely  self-contained  manner.  This  la  the  css*  baoause  the  n  priori  knowledge  that  the  airornft  Is 
stationary  on  the  ground  Implies  that  the  velocity  is  **ro  (to  within  the  email  oscillations  oauaad  by  wind 
buffeting)  so  that  the  reference  variable*  are  chosen  to  be  the  initial  manually  Inserted  position  and  zero  velocity, 
In  contrast,  If  the  Initialization  process  Is  carried  out  on  the  deck  of  an  aircraft  carrier,  the  velocity  and 
position  of  the  atroraft  fill  vary  a*  a  function  of  tin*  because  of  the  ihlp’ a  motion.  In  thl*  case  a  system 
external  to  the  elroraft  la  required  eo  that  adequate  Information  la  available  to  describe  the  motion  Df  the  ilroraft 
eyetem. 


Of  singular  Interest  here  le  Ah*  error  model  for  the  aircraft  inertial  system,  ilnoe  It  la  required  In  all  onaoi. 
Figure  3  displays  a  generalized  error  block  diagram  for  the  local-level  tree-inertlel  nevlgatlon  syetem.  It  l» 
a  linear  error  model  durlvud  by  eseentlally  aubtractlng  the  error-free  system  equation!  from  the  aotual  eyetem 
aquation  and  retaining  only  flrat-order  term*,  For  simplicity  the  vertical  channel  ha*  bean  omitted.  A»  oen  be 
■ten,  all  four  local-laval  mechanisations  are  included  In  thla  figure.  And,  as  might  be  expeoted,  various  simplloi- 
tlon*  oan  result  by  choosing  on*  particular  mechanization  of  intareat:  t.g.,  for  the  free  azimuth  mechanization, 

/(>.  a  0  .  Also  It  ahould  ba  notad  that  5p„  can  be  eliminated  from  the  error  model,  lines  ths  errors  d>,  and 
w,  always  appoar  in  the  fora  -  SSM  =  ¥  as  lnpu'a  Into  tha  various  nod**, 


At  time*  It  may  be  of  interest  to  know  the  latltud. t ngltud*,  and  wander  angle  errors  themselves,  For  nonpolar 
regions  they  are  given  by 
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whan  th*  subscript  C  means  computed  and  tha  auhaorlpt  T  means  true  (arror  free),  Cor  polar  roilona  tha 
relationship*  baoom*  nonlinear  function*  of  50,  ,  and  80,  booauaa  f\  nnd  8a  do  not  remain  mtmll. 

In  tho  derivation  of  thla  arror  model,  which  la  not  prnaentod  her*’,  three  coordinate  ayatemn  are  uaod: 
(1)  True,  defined  by  the  arror- free  ayatem. 


(11)  FUtform,  dtflnod  by  the  aotunl  lnatrument  oluater. 

(ill)  Conputar,  defined  by  the  actual  computed  value*  of  the  direction  coalnea. 

\ 

To  maintain  a  linear  error  model,  the  angular  aeparatlon  between  theaa  coordinate  ay a tome  must  remain  email  (lane 
than  10  doiroen), 


Tha  angular  aeparatlon  betwixm  the  true  and  tho  computer  ooordlnato  ayatoma  la  callod  tho  poaltlon  error,  S0,  , 
S8f  ,  and  80,  .  That  In  the  poaltlon  errors  (angular)  ara  tha  amnll  angular  rotations  SO,  ,  W  ,  and  S 6t 
about  the  true  x  ,  y  ,  z  axoa  neoenaary  to  bring  tho  true  t;xos  Into  coincidence  with  the  computer  axon. 


The  angular  aeparatlon  between  the  truo  and  the  platform  coordinate  lystem  la  called  the  platform  tilt  error, 

4't  ,  <t>y  ,  and  .  That  la  tho  tilt  errore  arc  tho  email  angular  rotations  <t>x  ,  tfy  ,  and  ahout  the  true 
i  ,  y  ,  r.  axoo  noeeseary  to  bring  the  true  axes  Into  coincidence  with  tho  platform  axes, 

The  angular  aeparatlon  between  the  oompuher  and  tha  platform  la  defined  by  the  anglaa  ®,  ,  \  ,  which 

ara  given  by  tha  components  of  tha  viotor  differentia  'V  -  ^  -  bO  ,  That  la  the  computer-platform  arrora  ara  tho 
•oall  angular  rotations,  H*  ,  ,  about  tha  computer  x  ,  y  ,  a  axes  naoaaaary  to  bring  tha  computer  axes 

into  coincident*  with  tha  platform  axe*. 

The  velocity  error  and  tha  platform  angulnr  rata  error  are  defined  by  tha  vaotur  difference  between  tha  computed 
values  and  tha  true  vr.luaa,  l.a., 

SV  «.  %c- If  (3.4) 

if?  1  £o  -£t  i  <a-8> 

Table  Ill  lists  tha  definitions  of  tha  remaining  variable*  appearing  In  Figure  3. 
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«,  THE  INITIALIZATION  PNOOkSS 

The  lnltlallaatlon  prooaaa  tor  tha  Inertial  navigation  ayatam  raoulraa  both  tha  initialization  of  tha  mechaniza¬ 
tion  dlf farent ill  aquations  with  tha  proper  valuolty,  position,  and  wandar  angle  and  tha  phyaloal  alignment  of  tha 
platform  to  tha  required  geographically  referenced  orientation.  Eaoh  type  of  aaohanlzatlon  oonaldared  here  raquiraa 
(Ideally)  that  tha  platform  bo  aligned  so  that  Iti  z  axli  coincides  with  th*  looal  perpendicular  of  tha  reference 
gaoid,  Tha  azimuth  orientation  for  north-pointing  eyatama  raquiraa  that  tha  y  axle  of  tha  platform  point  north: 
wharaaa  for  th*  wandar  azimuth  ayatam*  a  dichotomy  axiate  In  that  th*  platform  azimuth  must  agra*  with  tha  oomputad 
wandar  ailmuth  angle  or  vloa  vans. 

In  principle  tha  Initialization  prooaaa  could  occur  before,  during,  or  after  tha  aircraft  la  eatapultad  from  tha 
carrier,  In  aaoh  of  thasa  oases  th*  alroraft  la  In  motion  relative  to  tha  earth,  *o  that  aon*  internal  or  axtarnal 
(to  tha  alroraft  ayatam)  raftrano*  sensor  la  required,  Without  any  further  definition  or  reatrlotlon  on  tha  avail¬ 
ability  of  rafaranoa  atnaora,  aaoh  oaaa  can  have  e  multitude  of  different  poaaibl*  solutions  depending  upon  tha 
rsfarano*  aanaors  ohoaan.  To  limit  tho  vnsulng  dlacusalona  it  1*  therefor*  neoeaeary  to  limit  th*  oholoe  of 
rafaranoa  atnaora  oonaldared.  For  alignment  while  on  tha  uarrlar  deck  tha  rafaranoa  sensor  ohoaan  is  th*  ship's 
Inert  111  navigation  ayatam  (BINS),  Alignment  during  catapulting  1*  praoeded  by  poaltlon  and  velocity  Initialization 
and  flna  leveling,  using  SINS  data,  end  employe  ahlp  heading  or  tranapondar  ranging  to  parform  tha  azimuth  alignment 
while  catapulting.  For  in-flight  alignment  tha  raftrano*  oonalderad  la  tha  Doppler  radar  velocity  tensor.  A 
dlaouialon  of  each  of  thasa  technique*  in  given  in  th*  following  aaatlona. 

■afore  examining  that*  technique*  It  la  naoaaaary  to  dlaouaa  th*  quantitative  meaning  of  alignment.  Slnot  In 
toy  out  tha  initialisation  prooaaa,  aftar  a  praotloal  amount  of  tlia,  w'l  result  in  a  reildual  deviation  from 
tha  Ideal  (arror-frtt)  ayatem,  It  la  fair  to  aak  whan  la  a  ayatam  eonaii':..  >"'■  to  ba  aligned?  To  (newer  thla  queatiom 
It  muat  be  realised  that  what  la  actually  of  lnteraat  la  th*  aoouraoy  of  aubaaquant  navigation.  Thu*  It  la 

poaalbla  to  quantitatively  define  alignment  Implicitly  by  apaolfylng  th*  at .x racy  of  th*  aubaaquant  navigation. 
Howavtr  thla  la  uaually  not  done,  and  a  redundant  apaoifioatlon  of  botH  the  alignment  and  navigation  aoouraoy  la 
made,  Incompatibility  doe*  not  present  a  problem,  btoaua*  th*  allznmtnt  accuracy  1*  derived  from  th*  navigation 
aoouraoy;  and  there  axlata  a  high  oorralation  between  the  two.  Thus  tb*  syetea  1*  oonalderad  to  be  aligned  when 
It  baa  aat  tba  quantitative  apaoifioatlon  dictated  by  tha  user. 


5.  CARRIER  DECK  ALIONNENT 

It  la  generally  recognized  that  alignment  while  on  tha  deck  of  tha  oarrlar  will  produoa  th*  moat  accurata 
•nauiog  navigation,  However,  baoaua*  of  th*  complexity  of  handling  tha  multitude  of  aircraft  on  tha  flight  deck,  . 
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severe  restrictions  are  placed  on  the  acceptable  solutions  to  the  alignment  procedure  and  technique.  Thun,  In 
the  design  of  an  alignment  technique*  while  the  aircraft  ia  on  the  carrier  deck,  full  account  must  be  taken  of 
the  operational,  environmental,  and  control  couetrninta  Imposed, 

Before  the  strict  impo* l t ion  of  the  operational  conatralnta  two  technique*  had  been  proposed  that,  for  hiatorlcal 
raaaona,  are  worth  mentioning.  The  firat  technique,  called  trunefor  alignment1  employe  a  portable  master  inertial 
system  phyalcally  and  electrically  iwtod  with  the  aircraft  system,  Tlie  close  proximity  of  the  two  platforms  and 
the  angular  precision  of  the  mating  permit  accurate  glmbal  matching  for  azimuth  alignment  and  acceleration  matching 
for  level  alignment.  The  second  technique,  called  lnsortlon'l,i  employs  a  portable  aircraft  Inertial  navigator 
(PINS)  that  ia  prealigned  at  a  shipboard  console,  By  including  a  battery  and  aufflclent  computational  capability 
in  the  portable  unit,  it  can  be  removed  from  the  alignment  oonaole,  carried  to. a  waiting  aircraft,  and  Inserted, 
ready  for  operation, 

As  will  bo  seen,  the  operational  constraints  Imposed  rule  out  those  techniques  an  pooslble  solutions  and  impli¬ 
citly  require  that  the  alignment  take  place  with  the  inertial  navigator  in  the  aircraft.  The  combination  of  tho 
three  aforementioned  constraints  determines  tho  form  and  size  of  the  orror  controller  employed  in  tho  alignment 
technique,  A  discussion  of  each  of  those  constraints  and  their  ramifications  follows. 

9,1  Operational  Constraints 

To  avoid  Interference  with  any  of  the  normal  deck-handling  procedures  mob  as  fueling,  arming,  and  taxiing,  the 
tliinmtnt  la  to  ba  initiated  and  completed  without  any  manual  intervention  or  restriction  on  the  looatlon  and 
movement  of  alroraft.  This  succinctly  summarizes  the  operational  conatralnta.  Two  Immediately  obvious  ramifications 
art  that  no  power  cable  and  no  data  cable  can  be  used  for  the  alignment  technique,.  In  turn,  the  lack  of  the  power 
cable  requires  that  the  alignment  be  achieved  during  the  epoch  of  englna  turn-on  to  catapulting,  Also,  aolutlona 
Involving  special  alignment  stations  on  the  carrier  daak  to  afford  sufficient  time  with  englnee  on  tor  the  alignment 
to  ba  completed  are  implicitly  ruled  out,  l.e,,  no  loitering  for  the  expreee  purpoee  of  alignment  la  permitted  ainoe 
this  would  Interfere  with  the  normal  deck-handling  procedures, 

Without  an  additional  specification  the  time  allotted  for  alignment  la  ambiguous,  Thsrtfora,  after  oonsidoratlon 
of  the  normal  movements  of  an  aircraft  suhiequont  to  engine  turn-on,  an  alignment  time  la  specified  (by  the  uaer) 
excluding  any  taxiing  periods, 

The  imposition  of  a  specific  alignment  time  reaulta  In  an  instrument  performance  problem’ Both  the  accelero¬ 
meters  and  gyros  will  function  within  specification  if  they  art  operated  within  a  relatively  narrow  range  about  a 
daeign ■ temperature,  This  normal  operating  bumporature  la,  for  present  day  instruments,  considerably  above  expected 
ambient  temperatures,  Thus,  whan  the  platform  la  initially  turned  on  (energizing  the  heaters),  tha  instruments  will 
oyola  through  a  thermal  transient  until-  equilibrium  la  achlevad.  During  this  thermal  transient,  tha  instruments 
will  exhibit  transient  drift  and  blaa  characteristics  that  are  large  anough  and  last  long  enough  to  degrade  the 
allgnaant  process. 

Additionally  other  portions  of  tha  system  will  exhibit  undesirable  characteristics  during  this  thermal  transient 
phaaa.  The  duster  structure  may  exhibit  axcessivt  warpaga  due  to  thermal  gradients  and  this  may  result  In  instru- 
aent  non-orthogonalities  and  consequently  degrade  alignment.  Also  the  multitude  of  electronic  packages  required 
to  perform  auoh  functions  as  pulse  shaping  and  scaling  for  gyro  torquing,  sooeleron-'tar  proof  mesa  restoration, 
and  formation  of  the  velocity  output  pulses,  may  exhibit  abnormal  behavior  during  the  thermal  transient. 

The  solution  to  these  problems  requires  a  careful  aeohanioal  and  thermal  design  of  tha  various  inatrumanta, 
structures  and  alectronto  peckagsa  Involved  so  that  the  resulting  undesirable  thermal  transient  behavior,  If  not 
reduoed  to  a  negligible  value,  is  repeatable*  and  predictable  as  a  function  of  suitably  measured  tamperaturea, 

Since  tha  alroraft  system  requires  the  SINS  data  to  accomplish  alignment  and  no  data  cable  la  permitted,  It  la 
naoeaaary  to  resort  to  a  telemetering  system  to  obtain  the  required  information.  This  leads  to  a  problem  relating 
to  tha  existence  of  an  electromagnetic  radiator  on  the  aircraft  carrier,  It  la  obvious  that  at  tlmea  it  would  be 
darned  naoeaaary  to  maintain  the  carrier  electromaimetlcelly  silent.  If  thasa  times  of  alienee  coincide  with  tha 
timaa  that  alignment  la  to  ba  performed,  an  Incompatibility  arises,  Tha  solution  to  this  problem  la  one  of  mors 
specifically  defining  what  ia  meant  by  electromagnetic  silence,  Electromagnetic  ailenoa  la  desirable  to  avoid  tha 
possibility  of  the  carrier  revealing  lta  presence  to  an  ansmy,  Certainly,  if  the  radiation  pattern  and  power  are 
ao  designed  that,  (or  all  practical  purpoasa.'lt  la  detectable  only  on  the  oarritr  deck,  uas  of  an  electromagnetic 
radiator  during  a  period  of  alltnoe  will  not  endanger  the  oarritr.  Thus  appropriate  achievable  design  conatralnta 
on  tha  talenttarlng  system  will  Increase  lta  utility  to  covar  all  tinea. 

Additional  ramifications  do  result  becauaa  of  the  operational  oonstraints  imposed.  However,  they  result  btoauas 
of  the  ooupllng  of  tha  operational,  environmental  and  control  constraints  and  will  therefore  ba  dltcusstd  as  they 

arlat. 

5.*  Environmental  Constraints 

Carrier  deck  alignment  la  to  b«  performad  while  the  oarritr  is  pitching,  rolling,  yawing,  hatving,  surging,  and 
swaying.  In  addition  to  these  motions  tha  carrier  may  be  making  heading  changes  to  perform  evasive  maneuvers  or  to 
head  into  the  wind  in  anticipation  of  launching  or  receiving  alio  raft,  Additionally  the  alroraft  Itself  will  be 
buffeted  by  winds  ovtr  the  flight  deck,  thus  causing  motion  that  la  not  aentad  by  SINB.  Tha  dtglgn  of  the  alignment 
taohniqu#  requires  that  each  of  these  environmental  conditions  ba  taken  Into  account. 
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The  principal  effect  of  thceo  motion*  Is  rolated  to  the  reference  data  used  for  the  alignment  process.  The 
reference  date  supplied  by  the  SINS  to  tho  alrcrsft  system  via  the  data  link  consist  In  part  of  position  and 
velocity,  as  measured  by  the  SINS  Itself,  Since  the  slraraft  may  be  situated  anywhere  on  the  flight  deck,  the 
BINS  reference  data  must  be  compensated  for  the  relative  motion  before  they  can  be  adequately  used  as  alignment 
reference  data.  The  dats  required  to  perform  thla  compensation  conalst  of  the  vector  distance  between  the  SINS 
and  the  alroraft  plus  the  carrier's  pitch,  roll  and  heading,  end  their  rotes.  (Boo  Figure  3. )  Since  the  SINS 
Inherently  providea  these  angles  and  angular  ratos  it  is  reasonable  to  require  that  these  be  included  In  the  dats 
telemetered  to  the  alroraft.  On  the  other  hand  the  distance  botween  the  SINS  and  the  aircraft  will  vary  from 
elrorsft  to  alroraft  and  even  change  for  a  given  aircraft  if,  during  alignment,  it  taslea  to  a  now  deck  position. 
Prohibition  of  the  manual  Insertion  of  lever  trm  componenta,  a  restriction  imposed  by  the  operational  constraints, 
■eons  that  ths  alignment  technique  must  Include  a  method  far  the  estimation  of  the  lever  arm  components, 

$.3  Control  Constraints 

The  control  constraints  are  concerned  with  the  physical  limitations  of  the  Instruments  Involved  and  the  limita¬ 
tions  Imposed  by  the  presont  state  of  development  of  the  control  theory  to  bo  used  to  perform  the  alignment, 

The  primary  physical  limitation  of  the  instruments  that  affects  the  alignment  problem  la  the  maximum  torqulng 
rat*  that  can  be  applied  to  the  gyros,  In  rsallty  a  dual  phenomenon  Is  of  concern.  First  there  exists  an  absolute 
maximum  torqulng  rate  thet,  If  exceeded,  will  essentially  dsatray  the  gyre  torqulng  colli.  Stoond,  as  thla  maximum 
le  approached  from  the  lower  side,  the  accuracy  with  which  the  desired  angular  rate  la  auhleved  decreases,  t.e., 
torqulng  nonllnearltlai  become  significant. 

In  the  epplioation  of  modern  control  theory  to  the  cerrier  dealt  alignment  problem  the  limitation  that  slgnlfl- 
oantly  affects  the  eolutlon  U  the  liapoeltlon  of  linearity,  The  reason  for  this  will  become  apparent  In  the  follow¬ 
ing  dlscuseion. 

The  gyro  torqulng  limitation  aoupled  with  the  handi-off  operational  requirement  and  the  (got  that  the  lnetiument 
alueter' •  exlmuth  le  Initially  completely  unknnwn  leads  tot  nonlinear  estimation  problem.  To  underatsnd  how  thla 
rewulte  It  1»  necessary  to  review  tho  technique  cf  cowrie  alignment  of  the  instrument  duster, 

In  order  to  epply  linear  control  processes  to  ellgn  the  platform,  it  is  necessary  to  bring  the  platform  olose  to 
the  desired  orientation,  so  that  Unetrlittion  of  the  angular  deviations  ceil  be  assumed.  Theoretically  linearity 
atn  be  ttaumed  for  angular  deviation*  up  to  10  degrees,  From  t  practical  point  of  view  it  la  dsslrnbli  to  achieve 
a  aonsldersbly  smeller  deviation,  tine*  then  the  required  angular  rates  to  align  have  more  reasonable  magnitudes, 

For  alroraft  systems  the  platform  atn  be  approximately  leveled  by  nulling  out  the  pitch  and  roll  glmbal  raadoute, 
Thla  process  le  carried  out  while  the  gyros  ere  being  brought  up  to  speed  by  simply  torqulng  the  gimbals  with  thslr 
own  synchro  reedout  signals,  This  technique  le  lufflaiently  accurate  to  Justify  linearization  of  the  control 
problea,  since  it  results  in  e  deviation  of  approximately  1  degree  from  lsval  for  aircraft  on  ths  ground  and  2  to 
1  dagrass  far  aircraft  on  the  deck  of  a  carrier.  The  larger  level  cutree  alignment  errorn  on  the  anrrler  result 
from  the  pitching  and  rolling  of  th*  ship. 

The  aalmuth  of  the  platform  la  usually  slewed  to  approximately  north  (and  for  wander  axlmuth  mechanisations  tho 
computer  wander  ingle  le  initialized  it  aero)  by  torqulng  the  azimuth  glmbal  synchro  with  the  difference  between  the 
output  of  the  azimuth  glmbal  eynohro  and  a  synchro  signal  obtained  from  a  msgnstio  compass  indicating  ths  mssnstlo 
north  heading  of  th*  aircraft,  Additionally  th*  magnetic  heading  oan  be  compensated  for  magnetic  variation  to  make 
th*  aoarst  aalmuth  alignment  more  accurst*, 
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After  the  aoare*  alignment  phage  hte  been  completed  and  the  gyroe  are  brought  up  to  apetd,  th*  platform  Is  placed 
under  the  oontrol  of  the  gyros.  At  thla  t lam  the  fine  alignment  phsie  can  begin,  or  alternatively  additional  coir** 
alignment  In  level  aen  be  achieved  by  simply  torqulng  th*  gyro*  with  ths  output  of  th*  aco*  Urometer*.  The  addi¬ 
tional  oosra*  level  alignment  reduce*  th*  design  problem  for  th*  fin*  alignment  phase,  tino*  it  reduces  th*  dynemlo 
range  over  which  it  must  operate. 

The  epplioation  of  this  technique  for  shipboard  ootrse  alignment  unfortunately  fella,  This  le  baoauie  the 
magnetic  heeding  devloe  dose  not  function  with  guffislent  soourtoy  while  in  the  vlolnlty  of  the  saeslvi  atsel 
deck  end  superstructure  of  the  alroraft  carrier.  Thus,  although  the  platform  can  be  brought  to  g  reitonably  email 
aoaria  lsval  alignment,  no  direct  Information  la  available  to  slew  Its  aalmuth  to  an  approzimata  geogrsph'o 
rafaranaed  direction.  If  manual  Inaartlon  of  data  war*  permitted  ths  problim  oould  ba  easily  solved  by  visually 
estimating  (to  within  10  degrees)  th*  and*  between  tin  ship's  heeding  and  th*  aircraft’s  heading  (tha  spotting 
angli,  see  Figure  3),  This  angle,  along  with  the  ehip1  e  heading  from  BINS,  would  suffice  for  coeree  tzlauth 
alignment  by  either  slaving  the  ailnuth  glmbal  to  a  pri-aingned  direction  (euah  ae  north)  or  by  initializing  th* 
computer  wander  aalmuth  angle. 

It  ihould  be  pointed  out  that  If  tha  mechanisation  la  such  that  the  pisiform  Is  required  to  have  a  spsolfia 
azimuth  dlraotian  (as,  for  lnstsno*. ' In  th*  north-pointing  msohsn last  ion)  then  th*  platform  must  b*  does  to  that 
dealrtd  aalmuth  before  th*  gyros  have  assumed  oontrol,  Th*  rssson  for  this  Is  that,  bscaus*  of  ths  restriction 
on  maximum  tyro  torqujng,  an  sxaasslv*  amount  of  time  would  be  consumed  If  it  were  required  to  torque  the  platform 
through  a  large  angle. 

Th*  solution  to  this  problem  It  iclilevsd  by  choosing  on*  of  ths  wander  ealmuth  mechanisation*  end  omplnylng, 
after  the  gyros  Hive  assumed  control,  a  nonlliissr  sstlmatlun  process  to  estimate  the  platform's  winder  ingle  and 
initialli*  tha  oomputer. 
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For  th»  (round  alignment  oust  (so ro  referenco  velocity)  tho  vendor  angle  uf  ths  platform  In  estimated  from  tho 
r»»lduil  velocity  error  aftor  leveling  lias  aohlovod  steady  state’.  A  similar  procedure  nen  bn  used  for  carrier 
deck  slliniaont,  but  It  must  bu  dynamical,  since  the  aircraft  sill  be  accelerating  because  uf  the  carrier'll  motion 

This  station  has  examined  carrier  duck  alignment,  detailing  the  multitude  of  ramifications  of  the  operational, 
environmental,  and  control  constraints  imposed.  In  summary,  carrier  deck  alignment  must  take  place  to  s  specified 
accuracy  and  within  a  specified  time  under  the  following  conditions: 

(1)  No  power  cable, 
fit)  No  data  cable, 

(111)  No  rnsnuel  Insertion  of  spotting  angle. 

(iv)  No  manual  Insertion  of  lover  arm  components, 

(vi  No  loitering  for  the  sxprnsn  purpose  of  ellgnment. 

(vi)  No  restriction  on  location. 

(vlt)  Taxiing  permitted. 

In  Section  8  the  filtering  tochnlipicn  employed  In  the  solution  ,f  tills  problem  are  dlscusaad. 

I.  CATAPULT  ALIGNMENT 

The  most  tlme-aonaumlng  phase  of  the  Initialisation  process  Is  the  azimuth  alignment  of  the  platform,  principally 
beoauee  of  the  rate  at  which  the  azimuth  Information  propagates  into  measurable  observables.  In  in  unaoaelerated 
environment  tho  azimuth  misalignment  propagate!  Into  the  level  channel  at  a  rate  proportional  to  either  earth  rate 
or  spatial  rate,  Thii  represent*  a  relatively  week  coupling;  and  if  the  measurable  observables  are  contaminated 
with  extraneous  Information,  considerable  time  must  be  spent  extracting  the  misalignment,  In  an  accelerated  environ- 
aent,  the  aalmuth  misalignment  propagatsn  Into  the  level  ehatmtl  proportional  to  the  level  tooeleretlon  which,  if 
large  enough,  provide!  a  much  itronser  coupling  and  reduces  the  azimuth  alignment  time.  This  line  of  reasoning 
lead!  to  the  concept  of  pet  forming  the  azimuth  alignment  portion  of  the  initialization  process  while  the  alroreft 
la  being  catapulted  from  the  carrier, 

Several  different  approaches  have  bean  devised  to  perform  catapult  allgnmnnt,  one  spproaoh,  developed  by  NADC* 
Johnsvllle,  compares  the  veloalty  Increment  direction  at  computed  by  the  elroraft  system  with  tho  aatspult  direction 
ai  obtained  rrom  the  MNS-onmputed  ship1*  heading  plus  the  anile  between  the  ship's  heading  line  and  the  catapult. 

A  aeoond  approach  employ!  'two  transponders  mounted  un  the  carrier  end  compares  the  aircraft  aomputad  and  tranHpondur- 
neteurod  relative  position  to  eetlmate  the  eelmuth  misalignment.  Varloue  modifications  end  generalizations  of  theas 
two  technique*  are  obviously  poaslble, 

Before  aatapultlng  the  alroreft  buth  techniques  require  the  seme ’ amount  of  preparation,  l.e,  alignment  up  to  and 
including  fine  leveling.  It  possible  It  la  desirable  to  adhere  to  all  the  previous  operational  onnetrelnte,  however, 
it  Its  present  state  uf  development,  the  velocity  Increment  approach  requires  one  manually  inserted  piece  of  date: 
the  catapult  from  which  the  aircraft  le  to  be  Uunolied.  This  results  beeauas  the  technique  requires  the  angle 
between  the  ship's  heeding  line  end  the  catapult.  Since  there  are  four  catapults,  a  simple  manual  switch  attention 
is  ntoettery  bo  that  the  aumputer  aan  neleot  the  correct  pre-stursd  angle,  Other  then  this  exception  the  techniques 
art  encumbered  with  thv  ssinw  tasks  ss  carrier  deck  alignment,  l.e,  lever  trm  eattmetlon,  automatic  coarse  azimuth 
alignment,  relative  velocity  compensation,  permission  of  aircraft  movement,  and  fine  level  alignment,  It  should  be 
pointed  out  that,  linos  the  azimuth  alignment  Is  delayed  until  catapulting  occurs,  the  thermal  transient  problem  is 
somewhat  relieved  In  thul  the  platform  will  have  more  time  to  reach  thirmal  equilibrium. 

The  transponder  technique,  albeit  requiring  additional  equipment  both  on  the  alroreft  and  on  the  ilroraft  carrier, 
does  not  require  any  manual  Intervention.  In  fact  the  problem  of  lever  arm  estimation  la  reduced  to  limply  compu¬ 
ting  the  aircraft'  a  location  from  the  transponder  data  received,  thui  relieving  the  alignment  technique  of  tho 
burden  of  Implicit  estimation  of  the  lever  arm, 

With  reepeut  to  the  velocity  Increment  approach,  there  are  eeveral  elgnlfloint,  effeuta  that  take  place  during 
ogtgpultlng,  which  mu, '<t  be  considered  In  tho  design  of  the  technique  end  In  asaeselng  tho  accuracy  of  the  prooeee, 

The  more  significant  of  these  will  now  be  dlaouieed, 

While  being  catapulted  the  aircraft  la  fora  lb ly  constrained  to  the  dick  and  to  follow  the  catapult  track. 

Hoeevar,  because  the  track  will  not  preoleely  constrain  the  lateral  mntlon  of  the  aircraft,  an  error  In  the  reference 
direction  arleee,  This  le  because  tho  proaloe  of  the  technique  le  that  the  aircraft  (actually  Ite  platform)  muvea 
along  a  precisely  defined  line  relgtive  to  the  ship,  inherently  the  technique  hat  no  aethod  for  compensating  or 
auguring  this  motion,  Tho  problem  le  additionally  complicated  by  tha  fact  that  the  lateral  motion  of  the  wheel  in 
th«  track  aan  poaalbly  cause  an  amplified  lateral  motion  of  the  platform  depending  upon  ite  looetlon  in  the  alroreft. 
Without  a  technique  for  oumpensatlni  or  measuring  this  motion  It  represent!  an  Irremovable  error, 

luperimpoetd  on  the  lateral  traok  motion  le  the  motion  of  the  aircraft'!  Inertial  eyetem  due  to  the  ship's 
pitching,  rolling  and  yawing  (during  the  launching  of  alroreft  the  heading  of  the  ship  le  wilfully  maintained 

*  US  Naval  dir  Development  Center,  ,/ohnivi  I  le ,  llursiimfer,  Pennsylvania, 
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constant).  Slnco  the  i ti*1  rt  1  b1  system  measure*  oarth-rcfe ronccd  velocities,  it  will  be  sensitive  to  the  velocities 
induced  by  these  angular  muttons  coupled  through  the  lever  arm.  Thin  motion  can  anally  he  compensated  for  by 
uiliig  the  .pitch,  roll,  and  ynw  rates  aa  provided  by  sins  through  the  telemetering  ayatem  and  the  oatlmiUod  lever 

-  i, 

■Tnally  It  should  bo  recognized  that  the  accuracy  of  the  ship’s  heading  and  the  surveyed  angle  of  tlm  catapult 
i „wtr  prominently  and  directly  Into  the  accuracy  of  the  azimuth  alignment  achievable.  Senility  of  the  shlp’a 
.leading  data  la  also  of  concern.  Any  Inga  Induced  boenune  of  the  finite  dote  rate  of  tue  telemetering  system 
•Ill  induce  errors  proportional  to  the  angular  rate.  Senility  can  be  compensated  for  by  Increasing  the  dnta  rato 
or  introducing  prediction  tochnlnuoB  before  using  the  dnta. 

The  transponder  technique  similarly  Ims  several  efferta  to  he  considered.  Since  It  Is  utilizing  inf urnuit lim 
at  the  position  level  to  estimate  the  azimuth  misalignment,  it  la  not  plagued  hy  the  irremovable  catapult  error 
nor  the  necessity  fur  relative  velocity  correctlt.ii.  However,  slnro  the  position  ns  mnnaured  by  the  transponder 
is  relative  to  the  ship's  body  coordinates,  it  is  necessary  to  resolve  the  measured  position  into  the  local-luvcl 
coordinate  system-  This,  of  course,  requires  the  pitch,  roll,  and  heeding  uf  the  ship. 

Because  of  the  relatively  short  base  lino  available  for  the  transporting  system,  small-distanco  errors  can  lead 
to  relatively  large  azimuth  errors.  Thus  It  la  Important  to  obtain  an  accurate  survey  of  the  transponders  relative 
to  the  BINs.  Another  significant  possible  source  of  error  arises  hncausc  the  transponder’s  measured  position  is  not 
precisely  the  position  of  the  platform,  Howver.  this  displacement  error,  to  a  large  extent,  can  bo  compensated 
for  hy  using  the  inertial  syHtem  data. 

The  Hagle  most  significant  drawback  of  the  transponder  technique  la  the  need  to  add  additional  equipment  to  the 
already  overarowded  aircraft  avionic  system  and  to  require  an  additional  radiator  to  the  aircraft  earner.  Design 
constraints,  similar  to  those  imposed  on  the  telemetering  ayatem,  are  required  to  mulntaln  safety  and  security 
under  electromagnetic  silence. 


1,  IN-FLIGHT  ALIGNMENT 

Appreciating  the  numerous  difficulties  associated  with  carrltr  deck  and  catapult  alignment  It  la  worthwhile  to 
consider  that  alignment  be  delayed  until  after  the  Aircraft  has  left  the  carrier.  Tills  delay  would  eliminate  tha 
problem  uf  Interference  with  the  deck  handling  procedural  and  significantly  reduue  the  problem  associated  with  t|he 
platform  thermal  transients,  However  It  la  encumbered  with  problems  not  heretofore  considered,  The  discussion 
will  be  limited  to  performing  ln-flight  alignment  using  a  Doppler  radar  at  the  reference  ayatem.  The  details 
of  tha  synergistic  Doppler-Inertial  system  have  bean  adequately  discussed  in  Chapter  11,  so  that  only  problems 
peculiar  to  the  carrier  aircraft  application  will  be  considered  hare. 

To  •etsblieh  the  state  of  the  navigation  function  and  the  inertial  platform  at  the  time  ln-fllght  alignment 
begmg,  It  la  necteaary  to  dliouia  the  itquenaa  of  aventB  relative  to  the  navigation  process  from  engine  tarn-on 
until  the  etart  of  alignment.  It  la  apparant  that  thli  epoch  chould  be  kept  ae  small  as  possible  since  relatively 
poor,  If  any,  navigation  would  be  available  and  would  Introduce  position  errors  that  are  Irremovable  without 
additionally  complicating  the  navigation  funatlon  by  requiring  poaltion  updating. 

At  the  time  ln-fldght  alignment  begins  two  conditions  must  be  met,  first,  since  it  is  used  as  the  reference 
system  during  alignment,  the  Doppler  must  be  funnticnlng  properly.  This  is  specifically  polntad  out  because  a 
ooffliiiun,  although  not  neceaaary,  characteristic  of  a  Doppler  radar  Is  that  it  will  not  track  the  aircraft  velocity, 
until  it  has  axeseded  tome  specified  minimum  altitude,  Thus,  until  the  aircraft  has  attained  this  altitude  and  tha 
Doppltr  begins  to  track  the  velocity,  alignment  cannot  begin.  Sacond,  the  platform  muat  bo  coaraely  aligned  ao  that 
tha  Doppltr  data  can  be  transformed,  at  Least  approximately,  into  the  navigation  coordinate  system  and  also  to 
parmlt  linearization  of  the  alignment  process. 

One  technique  for  achieving  these  two  conditions  la  to  require  the  aircraft,  after  leaving  the  carrier  and  climbing 
to  a  gate  altitude,  to  fly  straight  and  level.  This  flight  oonditlon  is  maintained  long  enough  to  achieve  coarse 
platform  alignment  and  set  the  platform  under  gyro  control,  Cosrsa  alignment  is  performed  by  nulling  the  pitch 
and  roll  glmbala  and  slaving  the  azimuth  glmbal  lo  magnetic  north.  This  procedure  has  several  disadvantages,  it 
Increases  the  tine  before  ths  beginning  of  alignment  and  thus  the  tin*  during  which  relatively  poor  navigation  ia 
performed.  Alio  it  plaoee  a  oonetralnt  on  the  maneuvers  that  tha  aircraft  can  perform  after  takeoff  from  the 
carrier.  lastly  for  the  pilot  to  fly  etralght  and  leval  he  must  have  acme  refareno*  of  the  vertical.  Thla  could 
be  tha  horizon,  If  visibility  permits,  or  tome  ancillary  devloe, 

A  eecond  technique  would  be  to  perform  a  coarse  alignment  on  the  osrrler  deok  and,  aftar  tho  gyros  hive  assumed 
control  of  the  platform,  to  maintain  the  coarse  alignment  by  pendulous  ereotion  and  magnetic  heading  slaving.  Thla 
procedure  avoids  tha  naoaaalty  of  restricting  the  aircraft's  maneuvers  and  permits  alignment  to  begin  as  soon  aa 
ths  Doppler  begins  tracking  tha  velocity.  Careful  consideration  must  be  given  to  the  mechanization  at  thla 
technique,  tines  the  pendulouely  erected  platform  will  tilt  exorbitantly  during  large  horizontal  aoceleretlona 
(catapulting  and  turning)  and  the  magnetic  heading  device,  as  mentioned  pravlo-.sly,  will  have  large  errors  while 
on  the  carrier  deok. 

Iiceiflvi  platform  tilting  can  be  avoided  by  Inhibiting  erection  when  the  level  accelerometer  outputs  exceed 
ease  specified  value,  The  specific  value  would  be  ascertained  by  an  analysis  of  the  error  dynamics.  The  coarse 
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axiauth  sllgnaent  problea  la  handled  as  follows.  Since  an  erroneoui  magnetic  north  will  oc  indicatttl  on  th* 
deck  of  th*  carrlm ,  completion  of  coaree  azlautli  alignment  aunt  wait  until  the  aircraft  hns  left  tho  ahiji. 

However,  at  this  time  largo  er.louth  changes  of  tho  platform  cannot  toko  place  within  a  reasonable  amount  of  time 
because  of  the  Halt  on  tyru  tnrqulng.  It  is  therefore  necessary  to  euploy  a  wander  azimuth  aechanizatlon  and 
perform  ooarae  azimuth  alignment  by  proper  adjustment  of  the  cumputtr  wander  angle  and  not  tne  platform.  Thus, 
while  on  the  carrier  duck,  the  platfnra  la  at  first  coa'scly  aligned  to  the  aircraft  heading;  and.  aftor  the  gyroe 
•i,">  tssumerf  control,  the  coeputed  wander  angle  is  slaved  to  tho  difference  between  tlio  platform  heading  and 
■i Heated  magnetic  heading  (nee  Figure  A).  Since  Urge  alteratione  In  tho  computed  wander  angle  can  easily  oe 
made,  no  particular  difficulty  arista  when  thw  Indicated  aagnatic  heading  changaa  ilinlflcantly  as  the  aircraft 
leaves  the  slrcraft  carrier. 

Hie  foregoing  discussion  'stabilities  th*  state  of  the  navigation  function  and  ths  inertial  platform  at  the  time 
ln-flllhl  alignment  begins.  The  problems  associated  with  thm  over-water  alignment  proc-m  have  been  adequately 
dlicuaaed  in  Chapter  11  end  will  be  briefly  reltcreted  hers: 

(1)  Distortion  of  Doppler  spectrum  return  ower  water. 

(11)  loss  of  Doppler  return  over  very  smooth  water  surface. 

(ill)  Doppler  radar  meaturee  velocity  relative  to  water  currant  rather  then  aarth. 

i 

(iv)  Alignment  procaas  equivalent.  In  ton  to  ground  alignment  and  therefore  requires  a  relatively  long  tlaa. 

(v)  During  iliofiMnt,  t,  .vtga,  ianc»  it  degraded  ralativa  to  a  pre-allgned  eyatea. 

Sc caret  of  the  unpredictability  of  the  aea  condition!  and  the  length  of  time  required  for  in-flight  alignment, 
therm  it  a  prefeto'.c'  to  per  for*  the  eiignMnt  on  th*  carrier  daclt, 


I.  CARtlRR  DECK  ALIGNMENT  FILTER 

Aa  pentad  out  in  Section  S,  the  application  of  a  Kalaaa  filter  to  tho  carrier  deck  alignment  problem  muat  be 
preceded  by  an  estimation  of  the  wander  azimuth  angle.  Beoauaa  of  complete  lack  of  knowledge  of  the  azimuth 
orientation  of  the  platform,  the  initial  aander  asiauth  angle  ia  uniformly  distributed  between  -or  and  rt  , 

An  eztenelou  of  the  error  model  prwa anted  in  Section  2  to  Include  the  unknown  wander  angle  reaulte  in  a  aomplex 
nonlinear  model  involving  elnee  and  ooalnea  of  tbe  wander  angle.  Thus  a  direct  application  of  a  Kalman  filter  la 
not  pogilbl*. 

Raceme  the  Katun  filter  require*  a  linear  error  modal,  it  la  nacaaaary  to  aatiaata  the  large-angle  azimuth 
offset  by  zoma  other  hiii.  Since  the  linear  range  of  the  filter  (aln  6-6)  extendi  to  10°,  a  grata  aitlnate  can 
be  obtained  using  a  alniaum  variance  estimator11  coapriting  a  threo-etate  model  (azimuth  offaet,  two  platform  tllte) 
which  relates  commensurate  aircraft  and  SINS  velocities.  The  schema  ia  invoked  after  pendulous  ltvaling  has 
ocourrad  and  the  gyros  have  taken  control  of  tbe  platform.  For  convenience  the  vertical  platform  axis  ia  torquad 
so  that  the  coarse  azimuth  offeet  retains  coos tent.  Ooce  the  eatlzate  of  azimuth  offset  la  obtained,  the  alignment 
procaas  ia  linear,  tad  tht  standard  form  of  Kalian  filter  1*  used  to  perform  the  fins  alignment. 

One  of  the  sajor  considerations  in  the  application  of  a  Kalian  filter  la  tht  nun bar  of  atatae  to  be  modeled. 

Ae  the  nueibar  of  etates  la  increased  the  performance  of  th*  ayetaa  till  improve.  However,  a  point  of  diminishing 
returns  is  soon  ranched,  since  th*  inclusion  of  relatively  lnaignificant  error  processes  improve  tbe  performance 
slightly  but  increase  the  coaputer  requirements  enormouily.  The  choice  of  ths  number  of  states  for  the  application 
under  consideration  is  actually  baaed  oo  a  dual  use  of  the  filter.  The  filter  ia  required  not  only  to  perform  the 
carrier  deck  alignment  but  also  to  provide  the  euboptlmal  error  control  for  Doppler-inertial  navigation.  The 
tile  of  the  filter  la  therefore  dictated  by  the  node  requiring  the  moat  nuaber  of  states. 

Consideration  of  the  significant  error  processes  leads  to  a  oboloe  of  S3  states.  For  the  carrier  deck  alignment 
process  they  are  ^  • 

Foal t too  errors  2 

Velocity  errors  2 

Plat  form  tilts  2 

Azimuth  error  1 

Laval  gyro  drifts  2 

Horlicotal  lever  erne  2 

Reference  velocity  error  2 

Tat  model  for  the  first  eeven  errors  le  obtained  directly  from  Figure  2.  The  level  gyro  drifts  and  refertnee 
velocity  errors  are  modeled  ae  first-order  correlated  noise  processes.  Only  the  horizontal  lever  arm  components 
are  modeled,  since  during  alignment  the  alroreft  is  always  on  the  carrier  deck  and  the  vertical  lever  arm  (relative 
to  the  body  axes)  la  known.  Philo  the  aircraft  Is  stationary  on  the  flight  deck  the  body-axle  lever  arm  components 
are  tiae- Invar lent,  so  that  the  model  chosen  to  represent  them  ie  simply  a  constant.  This  type  of  model  is  the 
same  ae  a  flrat-oider  correlated  noise  process  with' infinite  correlation  time. 
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Although  level  errs  bias  le  Included  in  the  carrier  align  filter,  practically  no  gyro  biasing  will  occur. 

Because  of  the  high  quality  of  the  gyros  required  and  the  short  tine  of  alignment,  the  other  orrors  of  the  system 
till  dominate  and  not  permit  biaalng  to  occur.  However  tlioy  are  Included  for  two  reasons.  First,  thoy  are  rnquired 
for  Doppler-Inertial  navigation.  Socond,  they  can  be  used  for  periodic  gyro  biasing  to  remove  the  long-term 
(order  of  months)  drifts.  Tills  periodic  gyro  biasing  would  bo  amployed  at  scheduled  maintenance  time.  Undor  these 
oondltions  sufficient  time  le  evellsble  to  reduce  the  error*  of  the  system  to  such  tn  extent  that  the  biasing  will 
occur. 

Periods  of  taxiing  are  handled  as  followe:  while  the  aircraft  la  utationary  on  the  carrier  deck  its  wheel  brakea 
are  on.  If  the  aircraft  taxis  the  wheel  brakes  are  released,  Thus  a  simple  switch  indicating  the  itate  of  the 
brakes  provides  the  computer  with  a  discrete,  Using  this  diiorat*  the  computer  will  temporarily  suspend  alignmunt 
whenever  the  brakes  are  released  and  the  system  reverts  to  free-inortlal  navigation.  During  this  time  the  levor 
are  estimates  are  altered  by  integrating  the  difference  betweon  the  aircraft  computed  velocity  end  the  SINS 
telemetered  velocity  compensated  for  lover  arm  effects,  This  process  will  bo  In  error  beoauec  complete  alignment 
has  not  occurred.  Therefore  during  the  taxiing  the  filter  covariance  matrix  is  propagated  to  rofloot  the  fact  that 
the  errora  In  the  levor  am  estimates  ire  changing.  Once  the  brake  Is  rcspplled  the  lystem  reverts  to  the  alignment 
■process. 

The  observation  process  consists  of  comparing  the  aircraft  computed  velooity  with  the  BlNS-telemetered  velocity 
compensated  for  lever  arm  affects.  The  errors  associated  with  this  process  are  the  errors  In  alreraft-aomputed  t 
velocity  and  azimuth,  the  errora  In  the  SINS  velocity,  the  errora  in  the  lever  arm  aatlmatea,  and  the  errors  In  the 
SINS  pitch,  roll,  heading  and  their  rates.  Since  the  filter  states  do  not  model  the  errors  In  the  BINS  pitch,  roll, 
heeding,  end  their  rates,  these  errors  are  approximated  as  a  white  nolaa  In  the  observation  process, 

The  teak  of  filter  eynthciim  and  performance  estimation  require*  on  extenslvo  digital  computer  simulation.  Tha 
basic  computational  modules  of  tha  simulation  program  consist  of 

(1)  the  filter, 

(11)  the  real-world  system  error  model, 

(ill)  dynamics. 

Tha  filtar  modula  la  a  replica  of  tha  flltar  to  bs  programmed  on  the  aircraft'*  digital  computer.  Aa  such  It  will 
be  manipulated  to  obtain  a  compromised  auboptlmal  performance,  Tha  basic  objective  la  to  obtain  adaqumto  control 
of  Nbe  real  world  system  error  model  and  at  the  sue  time  minimize  the  computational  complexity.  The  real-world 
*ya;em  error  model  module  oonelsts  of  the  error  modal*  of  all  tha  varioua  subsystems  Involved  in  the  alignment 
pro, isse,  l.a.  the  aircraft  inertial  system,  the  SINS,  the  telemetering  system,  etc.  If  Mont*  Carlo  teohnlquoo  are 
employed  It  li  not  neceessry  that  these  error  aodels  be  linear.  The  dynamics  module  simulates  all  tha  various 
motions  of  tha  ship  and  tha  alraraft.  For  the  oarrler  deck  alignment  problem  It  Is  important  to  lncluds  the 
dynamic!  of  the  ship's  course  and  Ite  pitching,  rolling,  and  yawing1*.  Additionally  It  la  requirwd  to  simulate  the 
aircraft's  motion  on  the  carrier  deck,  while  It  Is  catapulting  and  after  catapulting. 

Tbs  simulation  prooaaa  for  filter  ayntheele  and  performance  estimation  oonaiata  of  controlling  the  real-world 
ayatem  error  aodel  with  the  gains  generated  by  tha  filter  under  test  for  a  particular  aat  of  dynamics.  The 
literature  contain*  many  axuples  of  auch  studies  for  problems  stellar  to  the  one  under  consideration  here11"14. 


t.  CONCLUSION 

This  ohaptsr  has  considered  the  application  of  Kalman  filtering  to  the  problem  of  alignment  of  carrier  aircraft 
Inertial  navigation  ayatema.  Considerable  detail  has  been  presented  to  establish  the  constraints  under  which  the 
flltar  la  to  be  designed. 

In  view  of  Its  usage  In  the  solution  of  tha  problta,  the  local-level  wander  azimuth  mechanization  and  error  modal 
war*  presented.  For  carrier  deok  .alignment  tha  interplay  batween  tha  operational,  environmental,  and  control 
constraint*  war*  used  to  define  the  conditions  under  which  the  filter  suet  perform. 

Catapult  and  ln-fllght  alignment  were  exulntd  as  altarnatlv*  or  supplaatntery  techniques.  Problems  similar  to 
those  enoountsred  In  oarrler  deck  alignment  were  found,  and  the  *u*  or  alternative  solution*  were  dlsouased. 

Finally  a  brief  discussion  of  the  filter  for  carrier  deck  alignment  warn  given. 
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A,  GEOMETRY 

•  NO  RESTRICTION  ON  POSITION  OF 
AIRCRAFT  ON  FLIGHT  DECK 

•  NO  data  or  power  cable 

•  NO  MANUAL  INSERTION  OF  LEVER  ARM 

•  NO  MANUAL  INSERTION  OF  SPOTTING  ANOLE 

»  AIRCRAFT  MAY  BE  MOVED  AFTER  ALIGNMENT 
HAS  BEEN  INITIATED 

•  CAPABILITY  OF  ALIONINO  IN  FIVE  MINUTES 

B.  DESIRED  OPERATIONAL  CHARACTERISTICS 


PiC,  3  Carrier  d««k  alicnMnt  MORttry 


INDICATED  MAGNETIC  NORTH 
(MAY  DEVIATE  CONSIDERABLY 
FROM  TRUE  NORTH  DUE  TO 
MASSIVE  STEEL  DECK  OF  CARRIER)  > 


PLATFORM  Y  AXIS 

(AIRCRAFT  HEADINO  AT 

TIME  OF  AZIMUTH  OIMBAL  CAGE) 


•e  -  COMPUTER  WANDER  ANGLE 
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CHAPTER  16 

SECTION  II  -  NAVIGATION  AT  SEA  USING!  THE  INVARIANTS 
FORM  OF1 -KALMAN  FILTERIN'! 

‘  * 


H.V.uabrook*  tod  H.Htluudirlit 


•Litton  aritiM  Ino. .  Hoodltnd  Hllli,  CtUfornlt,  DBA 


WtaUlt*  Potltlonin*  Oorporttiun 
18033  Vooturt  Hod 
Biclno,  CkUfornli,  DBA 


PRECEDING  PAGE  BLANK 


424 


NOTATION 


t,  9  oorariaaea  matrieaa 

X  aatlmataa  of  itata  varlablaa 

i  itata  rarlabla  matrix 

P  ajatam  dynamic!  aatrix 

0  i;ita  noli*  matrix 

»  lntnrnal  ayatam  nolma 

H  obaarvatlon  matrix 

i  obaarvatlon 

v  ■•uurenant  tiolaa 

Q  covarlanoa  of  lyatia  ooisa 

t  tlM 

)J  Kronaoktr  dalta 

Ajj  poaltion-dapandaat  covarlanoa  matrix  alaaanta 

Ajj  poaitlon/non-poaition  oovtrimnci  matrix  ilmmaotm 

Ijj  non-poiitlon-dapandant  oormrlmnct  matrix  alamanta 

cr, ,  alaaanta  of  atandard  covarlanoa  matrix 

ik  tranapoaad  atata  varlabi*  matrix 

Of,  U,  matrioan  uaad  in  oovarianoa  matrix  updata 

crr  ot,  of  atandard  daviation  of  aaaauraaant  nolaa 
af,  0,  tranapoaad  obaarvatlon  matrix 

Kalaan  gaina 

•uparaoript  -  indloataa  bafora  fix 

Buparsorlpt  +  indloataa  aftar  fix 

Bnbaorlpta  platform  axaa 

x,  r.  a, 


d>T  trua  Utituda 

\j  trua  lonaltuda 

4>t  axlmuth  aafla  arror 

10  Utituda  mrror , 

Ik  lnaxituda  arror 

Vp,  platform  x-valoclty 

Vpr  platform  y-valoclty 

(1  .  aarth  rotatloa  victor 

dp,  \  north  componant  of  aarth  rata 

dp  vartioal  ooaponant  of  aarth  rata 


platfora  Mill  ooaponant  of  earth  rat* 


iif  pi  at  fora  r-uli  coapouant  of  *artb  rat* 

plat  for*  v*rtloal-axU  ooaponant  of  *«rth  rat*  (*  -f!v) 
j  pi  at  fora- tut  vtotor 

i>t  tilt  about  platfora  x-axl* 

tilt  about  platfora  y-axi* 

•  Laplao*  operator 

«,  X-urro  drift  rat* 

*f,  E(  Y-iyro  drift  rat* 

«rror  la  x  and  y  coaponaat*  of  sarth  rat* 

Dm  drift  rat*  of  axlautb  «and«r  tail* 

3  platfora  apatlal  rat*  raotor 

u|T  i-axl*  apatlal  rat* 

it^T  x-ail*  apatlal  rat* 

y-axl*  apatlal  rat* 

P  craft  rat*  »*otor  (Vr/K) 

o,  x-axl*  oratt  rat*  (-Vpy/») 

t>t  y-axl*  oraft  rat*  (>  Vpi/ll) 

A  Pjj  oorralatlon  ooafflolint 

a,  abac  aaTth  radlua 

Vj,  JV,  platfora  x-axla  rdocity  error 

Vf,  JVN  platfora  y-axl*  raloolty  error 
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*yro~nol»*-aod*l  ooaatant 

c* tat It*  reciprocal  of  irro  oorralatlon  tla* 

DoppUr  noli*  aodal  oooatant 

Mtatir*  reciprocal  of  Doppltr  nol**  aodal  oorralatlon  tla* 
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Doppler  renge-veloolty  error 
(round  epeed 

totd  Doppler-drift-engle  error 
pletfore  heeding  (oreft  to  X  pletfore  egte) 
velocity  difference  of  lnertiel-Duppler  unite 
error  In  ground  epeed  (luoludlng  aonverelon) 

Doppler  eoele  feotor 

fluo tuition  error 

e-exie  Doppler  error 

y-eile  Doppler  error 

vertloel  eooeleretlou 

uoaeleroneter  non-orthogoaelltlee  (1*1,3) 

eooeleroaeter  blue  errore 

e-iooeleroneter  eoele  feotor 

y-enoeleroMter  eoele  feotor 

reolprooel  of  easeletoeeter  oorreletlon  tlee 

i-iyro  fcorqulng  ilgnil  free  filter 

y-gyro  torqulni  elinel  troi  filter 

reolprooel  af  gyro  oorreletlon  tlee 

eoplltude  of  irro  ooloe  drift 

e*illtud«  af  eoaeleroMter  nolee 

g-gyro  eoele-fkotor  error 

y-gyro  eoele-  footer  error 

■-•yro  eoele-feotor  error 

gyro  torquieg  retee 

gyro  eoa-ortboeonelltlee 

eooeleretlon-eeneltlve  drift  ooetflolente  for  gyroe 
eooeleretlon-iquered  drift  ooetflolente  for  gyroe 
gyrn-drlft  oorreletlon  tlee 
In t egret  Ion  elgoritho  conetent 
lotegretion  elgorlthn  aonetent 


CHAPTER  18 


RIOT  I  ON  It  -  NAVIGATION  AT  SEA  US  I  NO  THE  INVARIANTS 
PORN  Or  RALMAN  PILTERINO 

H,  W.Banbrook  ind  H.ttalamandarla 


1,  INTRODUCTION 

MaahanlaaUou  concepts  employing  optimal  control  technique a  have  bean  applied  to  guidance  and  navigation  problems 
ovar  tha  put  f tva  yaara,  tha  objaot  bains  to  produce  a  syatem  whloh  exhibit!  a  minimum  arror  varlanoa  undar  the 
constraint  of  time-optimality.  Tha  lattar  U  attained  by  asperating  tha  signal  fron  tha  noiaa  in  tha  aid  aanaor 
data  and  aaxiaally  utilising  thia  data, 

* 

martial  uaiuraiant  units  (INI)  exhibit  arror  charactariatica  which  srow  with  time,  A  asohanlution  utilising 
aid  lantern  to  damp  and/nr  "bound"  tha  Insrtlal-unlt-arrnr  charaotarlatloa  la  daalrad.  By  airing  a  Doppler  radar 
whloh  poataaa*  good  long-tarn  atahiUty  and  an  lnurtlal  nauuraaant  unit  which  has  good  ahurt-tarn  utability,  the 
overall  ayatan  accuracy  li  gr  y  Improved  ovar  that  attainable  from  althar  aanaor  independently. 

Tha  inartlel  ayatan  is  tha  p  unary  aanaor  and  tha  Doppler  serves  as  i  lie  aid  aanaor,  Observations  made  by  the 
Doppler  are  contaminated  by  tha  aaa  currant  drifts,  linos  the  Doppler  meamuramanta  ara  relative  to  tha  water  must, 
Tha  applloatlon  dlacuaiad  In  thla  aaotion  ipaclfloally  addraaaaa  an  alrborna  application;  however,  tha  mathematical 
■aohanlmatlon  mi  oonflgurod  la  dlraatly  applicable  to  a  shipboard  inertial  unit  damped  by  an  EM  log  or  Doppler 
sonar ,  In  althar  tha  alrborna  or  shipboard  cue,  tha  largsit  arror  contributor  in  tha  Doppler  observation  la  the 
aaa  ourrsnt  drift!  Tha  hardware  blaaaa  characteristic  of  nodarn  alrborna  and  shipboard  sonar  Dopplaro  bra 
relatively  mil  ooaparad  to  tha  aaa  nolaaa. 

Thla  aaotion  contains  a  brief  summary  of  Kalman  filtering  theory  whloh,  through  a  transformation  of  variables, 
la  extended  to  tha  lovarlants  form  of  Kalman  filtering,  ,A  north-seeking  modal  li  discussed  herein  for  llluitrntive 
purposes. 

Practical  oonslderatlona  play  an  Important  role  In  configuring  a  Kelaan  filter;  for  Instance,  to  mechanize  an 
optlaal  filter  for  an  Inertial  navigation  ay a tarn  raquirai  an  expanded  asnory  alrborna  (or  shlpborne)  computer,  Dut 
to  weight,  volume,  coat,  power  reliability  and  Maintainability  constraints,  it  la  not,  In  genaral,  daairabla  to 
laplaaant  a  fully-optlmlaad  system.  Therefora,  auboptlmal  filter  mechanisations  am  generally  Influenced  by  tha 
above-mentioned  constraints.  In  kaaplng  with  thla  thinking,  the  tnvarlanti  taobnloua  minimizes  the  number  of 
differential  equatloni  to  be  programed  in  tha  oovsrltnes  matrix,  Alio  scaling  requirements,  for  tha  covariance 
■atria,  ara  not  as  stringant  baoauaa  of  tha  bounded  shiraotariatlos  of  aubseti  of  tha  oovariance  matrix.  Further, 
tha  theoretloal  aoouraoy  realizable  from  tha  lovarimnta  fora  of  tha  Kslun  filter  la  u  good  a*  tha  olaaalcal 
Raima  filter,  Howevtr,  tha  word-length  requirements  can  be  rallied  aomawhat  for  tha  Invariants  taohnlqus  bacauaa 
It  la  lama  aanaltlvt  to  truncation  and  round-off  affects  than'  tha  classical  Kalman  filter. 

To  Illustrate  tha  potential  aoouraoy  improvement  attainable  from  the  implementation  of  tha  optlul  filter, 

•action  J  shows  tha  result  of  a  slaulatlon  for  which  tha  filter  tea  run  ai  en  (open-loop)  eitlmstor  rathor  than  a 
(oloied-loop)  controller.  Tha  degree  of  predictability  can  be  gain  from  tha  Illustration  In  Seotlon  5.  The 
ooooluglon  1*  that  tha  Invariants  fora  of  Hainan  filtering  010  indeed  pradiot  tha  atatas  of  the  ayatan. 


I.  RALMAN  HLTIR  THEORY  POR  THE  INVARIANT!  TECHNIQUE 

R.  1  Oaaaral 

Thla  aubaaotlon  contain*  tha  aumaary  of  Kalman's  aquation  and  tha  applloatlon  of  tha  Kalman  filter  btaad  on  tha 
Litton  invariant!  technique.  Tha  genaral  method  la  that  aaplcyad  by  Kalman.  Certain  modifications  have  bean  made 
to  acoomttdate  conatralnti  impoied  by  tha  auboptlmal  oharacterletioi  of  tha  aaohanizad  filtar.  Alio  certain 
raflntmeata,  auch  u  ezponantial  torquing  of  tha  gyroi  and  Doppler,  have  been  incorporated  to  simulate  the  effect 
of  exponent  tally- correlated  nolle  eourcea.  The  following  dlicuaslon  preient*  the  general  philosophy  of  the 
Kalman  filter. 

Tha  laartlal  navigation  alaaant  (XKU  plua  computer)  provldam  tha  ooaplate  navigation  function;  however,  by 
using  redundant  data,  Its  performance  can  be  improved,  The  primary  aid  eenior  considered  (the  Doppler  radar) 
providea  velocity  information  In  tha  torn  of  ground  spied  and  Doppler  drift  angle.  The  Doppler  radar  uleo  requires 
a  beading  reference  auch  that  combination  of  theae  aeneora  can  alio  perform  the  navigation  function,  although  it 
is  laaewhat  degraded.  An  alternative  of  the  Doppler  velocity  la  to  damp  tha  inertial  syetem.  The  aid  aansors 
also  provide  Intermittent  position  data. 
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Thui  it  la  aeon  that  tlio  varluus  othor  avionic  mibsyetoma  provide  a  redundant  measurement  of  position  and 
velocity.  Optimal  usage  of  this  redundant  information  requires  a  detailed  examination  of  the  relativu  errors  ol 
tha  various  sensors  in  addition  to  the  availability  of  the  data. 

There  are  various  methods  of  utilising  the  redundant  information,  their  quality  depending  heavily  un  thu 
accounting  fur  the  many  typea.  particular  mugnitudea  ajid  apectra  of  error  souroee.  Of  prime  concern  are  classical 
and  Kalman  moo hanl tat  ions.  Slnoo  all  mochanlmntlons  ara  imperfect.,  the  problem  is  to  extract  signal  from  nolso. 

The  classleal  mechanization  approach  is  to  let  the  systems  do  much  of  the  filtering  by  utilizing  feedback. 

This  chapter  considers  Kalman  riltoring  far  airborne  alignment  and  navigation.  It  la  well  known  that  such  a 
filter  technique  results  in  a  minimum  variance  error  for  tha  asnumud-nystem-error  model. 

Tho  orror  propagation  of  the  inertial  unit  and  Hippier  error  ars  both  atrongly  f llght-path-dcpondent ,  honoo 
tine-varying.  Since  tho  flight  path  la  not  fixed  for  all  possible  missions,  it  is  clear  that  thero  should  bo 
tome  onboard  accounting  for  flight  path  in  tho  filtering,  aa  referred  to  loter,  to  ohtain  host  system  performance, 
Where  intermittent  or  occasional  information  is  supplied,  such  an  position  data,  tho  Kalman  filter  is  especially 
aulted  bocnuHo  of  its  capability  of  making  largo  corrections  throughout  the  inertial  system.  Provided  tho  system 
error  model  is  sufficiently  realistic,  improved  system  performance  is  obtained  by  employing  Kalman  filtering 
techniques.  Tho  mechanization  advantages  of  clussical  feedback  arc  obtainable  in  Kalman  filtering.  With  a  digital 
computer,  it  Is  important  to  note  that  the  selection  of  filtering  methods  is  reduoed  to  only  two  considerations: 

(1)  Syetem  performance 
(11)  Computer  requirements. 

This  implies  a  sophisticated  model  because  there  are  many  important  error  sources  and  typea  of  error  propagation. 
Any  increase  of  lophlitication  of  tha  error  model  typically  implies  increased  programming  requirements.  Utilization 
of  results  of  investigations  of  computation  techniques  closely  related  to  tha  deeper  aspects  of  tha  Kalman  filter 
approaoh  ara  evidently  not  only  warranted,  but  eliould  be  given  priority, 

A  frequently  considered  aspect  of  the  uae  of  any  filtering  teohnique  is  the  dependence  on  oorreotnoes  of  the 
hypothesized  error  model.  If  t  sophisticated  error  propagation  model  is  used,  then  unreallam  can  stem  only  rrom 
inaccuracy  of  statistical  estimate*  of  error  source  magnitudes,  e, g,  drift-rate  characteristics  of  tho  particular 
gyro.  If  the  mechanization  of' the  Kalman  filter  Is  a  feedbaok  system,  aa  la  the  propoeed  system,  then  tho 
adventagee  of  the  relative  Insensitivity  of  that  type  of  system  to  unexpectedly  largo  errors  are  attained.  In 
all  simulations  of  Kalman  riltara  at  Litton,  it  should  be  mentioned  that  error  aourcaa  have  particular  oharao- 
tariation  insaoh  run,  randomly  ohoaen  from  a  distribution  with  the  assumed  oharaatarlatioe. 

•  ' 

Tha  prlnolpal  difficulty  In  applying  Kalman  filtering  to  airborne  systems  was  the  large  oomputer  capacity 
required  to  uechaniza  tha  myriad  eqnatlone.  Litton  hu  managed,  by  traneformatlon  of  variables,  sequential 
computation,  and  approximations,  to  simplify  Kalman's  general  mechanization  equations. 
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The  transformation  of  variables  ii  ana  In  which  the  majority  of  the  elements  of  the  system  covariance  matrix 
ara  invariant  to  tha  position  aid  oanaor  data.  This  transformation  of  variables  is  praaantad  in  more  detail  in  a 
later  section. 

2.8  Claamteal  Kalman- Filter-Equation  Suewary  and 
Mathematical  Preliminaries 

Tha  mathematical  development  of  the  olaaaioal  Kalman- filter  equations  le  formulated  in  myriad  rsoant  publications, 
including  Kalman’s  oompleta  documentation1;  hence,  theee  aquations  will  not  be  derived  hers  but  merely  summarized 
and  described  in  general  terms. 

’table  1  summarizes  tht  Kalman/Litton  equations  that  would  typically  ba  mechanized  in  an  aided  inertial  navigation 
eyatam  for  alignment  and  navigation.  The  notation  employed  lm  that  used  by  Kalman.'  Underlined  capital  letters 
signify  matrices,  underlined  lower-oesa  letter!  signify  vector  quantities  (oolumn  matrices).  A  prim*  signifies  the 
transpose  of,  the  “hat"  sign  signifies  beet  estimate  of,  the  +  sign  eignifiem  the  pseudo- Inverse  of,  and  E  means 
the  expected  vtlue  of,  The  olaaaioal  Kalman  filter  la  modified  slightly  in  that  the  bast  estimates  of  stats 
variables  f  ara  updated  with  information  inoluding  tha  N1*1  inurement  of  tima. 

In  satting  up  a  Litton  mechanization,  the  flrat  ztep  is  to  (elect  a  sat  of  stats  variables,  These  will  normally 
be  any  and  every  quantity  whloh  wa  wish  to  update  and  sufficient  states  to  adequately  deiorlbe  tbe  dynamics  of 
the  system. 

The  next  etep  ii  to  represent  the  ayetem  dynamics  by  a  sit  of  first-order  lintar  differential  aquations  of  tha 
fora  of  Equation  (2. 1).  Theae  exist  as  a  sat  of  such  aquations  by  defining  tha  state  variables  ns  trrnr  quantities. 
For  example,  the  stats  varlablea  are  not  dtfinad  aa  "position"  and  "velocity",  but  as  "arror  in  ponition"  and 
"error  in  velocity",  Tht  standard  linearized  error  <•  tuitions  (naglectlng  i«oond-and-higher-ordor  terms  in  error 
qusntitiea)  will  then  provld*  equations  uf  the  form  of  Equation  (2. 1).  Inspection  of  theae  equationt  yields  the 
E  and  a  metrical,  where  £  ii  referenced  os  the  eyitem  dynamics  matrix. 

Tha  Ow  tarma  represent  internally  generated  uolse.  Oyro  drift  noise  ii  an  txample  of  internal  nolle  represented 
by  aliments  of  Qw  . 
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TABLE  l 

Suamary  of  Kalman  Filtering  Equations 


Defining  Equation* 

Statu  varlablen: 

dj 

X  rr  =  El  +  2* 

ttb 

Observed  quantities: 

2  2  =  Ui  +  I 

Initialize  »lth  bast  available  eitimates  of  state  varisbloo  2  and  covariance 
matrix  E  (error  in  estimates) 


Between  updating  points: 


(a)  Propagate  state  variable  estimates  by  —  =  Cl  (2.3) 


(b)  Propagate  covariance  by  —  =  f£+  +  Bfifl '  ,  (2.4) 

d  t  “ 

where  2  =  cov[|]  =  etl.i'l 
Q  =  eov[j]  s-  Etjg1] 

R  a  cov  ty]  e  ECiy'1 

Note:  To  uie  Equations  (3.4)  through  (3.7)  we  assume  E[wv'j  -  0  ,  i.e. , 
w  and  £  are  uncorrelated. 

(a)  Correct  state  variables  by  A{  -  g(j-8|>  (2.  S) 

K  =  lU'  EBsB'  +  •  (2.U). 

where  0  s  H5U'  +  g  is  a  scalar  quantity  if  updatea  are  based  on  only  one 

measurement  at  a  tine. 

(b)  Correct  covariance  matrix  by  &£  =  -gHg  -  -DjtK '  ,  (2.7) 


The  observed  or  measured  quantities  used  to  update  the  state  variables  isuat  also  be  specified.  These  are 
position  checkpoints  and  Doppler  velocity  eeaauraeents.  These  "observables"  must  be  eepreseed  as  a  linear  funotlon 
of  tha  state  verlablea,  aa  in  Equation  (2.2).  The  linearized  error  equation!  expressing  arrora  in  observations 
as  fuaetlona  of  errors  in  the  state  variables  provide  Equation  (2.2)  and  the  observation  matrix  H  . 

The  1  vaotor  rtpreaents  measurement  errors.  In  acat  practical  applications,  the  aaaauramant  arrora  v  are 
unoorralkted  with  (statistically  independent  of)  the  internal  noist  w  .  To  alepUfy  tha  renaindsr  of  the  equations, 
aacuat  that  E[wv']  r.  0  . 

Equations  (2.3)  and  (2.4)  are  the  mechanization  equation!  for  real  time  computation  of  the  eetimnted  values 
of  the  etate  variables  and  the  expected  variance  in  these  eatiaatea.  Equations  (2.  3)  are  essentially  tlia  navigation 
equations  which  are  already  aeohaniztd  in  the  Inertial  navigation  ayatam.  Equation  (2.4)  la  new  to  the  mechaniza¬ 
tion.  Tha  covariance  £  represents  a  running  eatiaate  of  tha  accuracy  or  Confidence  in  the  syetem  estimates  of 
each  state  variable.  In  effect,  the  eystea  CEP  it  continually  computed,  implying  that  ttii  covarianoa  matrix  la  a 
running  error  analysis. 

Equations  (2.3)  and  (2.4)  art  diffarantlal  equations  which  art  solved  by  Integrating  from  some  known  starting 
point.  Initialization  is  a  familiar  problem  for  Equation  (2.3)  and  corresponds  to  aligning  the  platform,  and 
setting  in  initial  velocity  and  positions  into  the  computer.  To  initialize  Equation  (2.4),  an  estimate  of  plat¬ 
form  alignment,  gyro  calibretion  ar.d  computer  Initialization  acouraoy  must  be  made.  Such  estimates  are  based  on 
error  analyses  and  actual  teat  data.  These  estlaates  ere  not  critical  to  the  process  if  they  are  not  grossly 
unde rent  Hated  studies  show  that  it  is  better  to  overestimate  the  error  for  the  self-correlated  terms  (variances) 
rather  than  to  underestimate,  whereae  it  la  better  to  underestimate  the  cross-correlated  terms  (covariances). 

Upon  initializing  Equations  (2.3)  and  (2.4)  the  computer  continuously  trnoka  the  state  variables  snd  updates  the 
covariance  matrix  by  Integrating  Equations  (3. 3)  snd  (3. 4)  in  real  tine. 

*han  aid  information  la  obtained  from  separate’ measurements  or  observations,  the  present  estimates  of  the  stste 
variables  and  covariance  matrix  are  upuated  according  to  Equations  (2.9)  and  (2.7).  Equation  (2.5)  statea  that 
a  comparison  of  tbs  measured  value  z  with  the  present  estimate  a|  be  made,  and  this  difference  signal  multiplied 
by  a  feedback  gain  g  . 
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Qno  of  tho  ilnpliflcetlone  instituted  by  Litton  i>  to  serially  updat )  after  a  moaaurtnont.  Even  If  data  from 
two  or  more  measurements  art  available  slauHsneausly,  tho  data  san  atill  be  prooeiaml  aerially  as  several  single 
■sasurwaents  and  the  system  sequentially  updated.  This  proceduro  reduces  each  of  the  1)  matrices  to  a  single 
row  matrix.  This  in  turn  takes  the  quantity  H£u'  +  &  a  scalar  quantity,  and  the  inverse  or  a  scalnr  D  la 
simply  its  reciprocal  D*1  . 

Once  the  filter  gain  &  and  the  scalar  D  from  Equation  (2.6)  are  computed,  the  corrections  to  tho  elements 
of  the  cover.' S'  1  matrix  beoome  almost  trivial,  as  seen  in  Equation  (2.7).  Following  the  update  corrections,  the 
systems  compute  ions  revert  back  to  Equations  (2.3)  and  (2.4)  in  order  to  propugatc  tho  system  estimates  forward 
in  real  time  until  the  next  system  updating  occurs. 

In  addition  to  the  above,  the  development  of  the  correction  Invariant  formulas  requires  a  cursory  knowledge  of 
tensor  notation,  specifically,  the  ocncept  of  the  summation  convention.  In  tennorB,  to  denote  different  quantities, 
•upersorlpt  Indies*  are  omployed.  In  the  development  which  follows,  subscripts  are  used  throughout  except  on  tho 
Krouecker  delta  terms. 


In  writing  homogeneous  linear  and  quadratic  functions  summed  over  some  Index,  tho  following  typos  of  formulas, 
raspectlvely,  result: 


£  v» 


+  a.x.  +  s.x. 


£.  &  ‘u 


Vj  =  aux*  *  a,,x{  +  ...  +  a0BxJ  + 


+  alJXtX,  +  +  ...  +  s,„x,x„  + 


+  a^ijx^  +  s^x,  4  ...  +  a^XjX,,  + 

4  ...  ♦  »„,*,*!  +  ••• 

These  two  equations  art  systems  of  ths  first  ordar  and  ayatema  of  tha  second  order,  respectively.  A  ayatem 
of  order  zero  has  np  indices  and  thus  la  invariant. 

In  tha  oouras  of  tha  derivations  that  follow,  ths  summation  signs  (X)  would  be  used  quite  frequently.  To 
preient  s  more  eompaot  appearance  for  tha  formulas,  ths  I  sign  will  ba  droppsd  and  la  incited  whenever  an  index 
ie  repeated  in  the  expression,  e.g. , 

jfe  Vj  «  Vj 

and,  mines  J  la  rapeatad,  the  auenatlon  over  J  is  implied  on  tha  rigut-hand  aids  of  the  expression  above. 

The  convention  appllee  in  similar  manner  to  the  double  summation,  since  the  indices  )  and  k  ara  both  rapaatad. 
To  tsollltata  the  analysis,  a  dummy  index  la  frequently  employed.  An  index  net  repented  la  a  fraa  lndax  and  span* 
any  dimension  assigned. 

Tha  Kranwcker  delta  (8 Is  a  mixad  tansor  of  ths  atcond  order  (rank  two),  bacaust  it  employs  both  subscripts 
end  superscripts  and  haa  tha  unique  property  that 


8g  „  (0  if  J=k 
J  \l  if  J  =  k 


2.3  General  Implications  of  Correction  Invariant! 

The  error  propagation  of  the  Inertial  system  can  be  ehown  to  be  oomputed  by  differential  aquations  in  the 
oovarlance  matrix,  which,  by  a  ipeolal  transformation  of  variablas,  haa  tha  form 
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whtra  R.S  ara  invariant  undtr  Kalman  oorrsetiona  with  reapset  to  a  ohoeau  subset  of  observed  state  variables 
and  £  fa  the  Inverse  of  the  matrix  of  that  ohostn  subset  of  variables  which  art,  in  part,  directly  observed  by 
mid  mwnsors. 

The  A  submatrix,  whloh  comprises  tha  small  portion  of  non- invariant*  of  the  computation  set,  is  functionally 
tha  lovaraa  of  a  partition  of  the  arror  matrix  and,  as  such,  haa  diagonal  tarns  that  vary  proportionally  to  system 
acouracy  whloh,  In  turn,  lias  between  zero  and  a  sharply  defined  upper  band.  In  oontrast,  the  direct  error 
quantities  are  relatively  unbounded.  Useful  lnforaaticn  is  bast  mappsd  in  terms  of  accuracy  measure  in  statistics 
for  combination  with  other  information.  (Thuc,  defining  acouracy  A  a  1 /o’  ,  where  is  the  variance  of  the 
position  data,  it  follows  that  the  accuracy  obtainable  by  many  observations  is  the  aum  of  Aj  . ) 
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Daf Inins  Kilim'  s  covmrieiic*  matrix  u  o  ,  with  subscripts  x  and  y  denoting  thepoeltlon  variable*,  the 
A  submatrix  1*  functionally 


A 


P< 


'pa 


ayy 

“asy 

,<7»y 

"is 

a,fxx  -  axt3 


Tht  R  invariants,  wliioh  appear  in  tho  Kalman  weighting  for  inertial  system  tria-up,  poeaoaa  the  functional 
behavior  of  ration  of  related  covarianceu.  Tho  ratioa  have  relatively  limited  range  ooepared  to  rotated  corrola- 
tlona.  Functionally,  the  R  eubmatrix  is 

*ra  s  <rrk*ka  ■ 

where  r  >  k  .  a  <  It  ,  and  r  and  a  refer  to  the  members  of  tho  R  autwi*trfxT 

The  s  invariants  (comprising  tho  larger  part  of  modified  matrix  equations),  which  correspond  to  correlations 
of  non-observables,  are  the  aost  lnsensltlvo  to  the  aid  data  profile,  This  offers  a  potential  memory  reduction 
by  using  approximations  which  do  not  materially  compromise  performance  optimality,  The  S  subaatrix  elements  have 
the  aaae  unit*  at  the  corresponding  aembcri  of  the  classical  covariance  matrix  (o)  and  funotionally  art 


~  RrktTks  • 


where  r  ,  a  >  k  . 

The  choice  of  oarrmotlon  Invariant!  with  respact  to  poiitlon  observations  lead*  to  error  propagation  differential 
equations  in  which  latitude  error  effeote  in  level  and  vertical  components  of  earth  rate  and  Coriolis  computation 
are  largely  eliminated  from  the  R  end  s  eubmatrix  element*.  This  presents  a  memory  saving  and  rsmovss  problem 
of  computation  of  very  small  tsrms  whose  integrated  magnitude  over  10  hours  may,  nevertheless,  be  subetsntlal. 

The  correction  invarlsnti  tend  to  retain  tht  simple  oroei-channel  oharacterletlos  of  the  pur*  inertial  system, 
otherwise  disturbed  by  the  aiding  proceis.  Thtaa  characteristics  are  principally  the  result  of  azimuth  error 
and,  usually  to  a  leaser  degree,  latitude  error  entering  earth  rata  aatimatea,  With  computation  in  invariant  form, 
.it  has  been  demonstratad ■ that  a .reduction  in  differential -equation  programming  is  feasible,  the  obviated  equations 
being  replaced  with  a  few  closed  form  azimuthal  correlation  relations  which  onabli  azimuth  corrsctlon  baaed  on 
acoelerativ*  effeote  (important  at  high  latitudes).  The  computation  techniques  proposed  for  the  invariants  art 
presented  in  the  lubseoient  paragraphs, 

The  A  subaatrlx  la  restricted  to  contain  only  position  variable*:  the  R  eubmatrix  contain*  th*  covariance 
of  on*  poaltion  variable  with  on*  non-position  variable.  Th*  S  eubmatrix  contain  the  oovariancs  of  all  qon- 
posltion  variables  with  uon-posttlon  variables. 

2.4  Algebruio  Form  or  Correction  Invariants 

An  observation  involving  a  given  subset  of  system  error  *k,  k  -  1 .  K  of  form 

i  s  ^  *k°k  +  N 


1*  utillzod  for  Kalman  corrections  (analogous  to  Kslman1 t  expression,  j  =  jjx  +  £)  of  eaoh  system  variable,  where 
It  may  be  ehosn  that  the  ohangs  upon  aorrection  Implies  that 


crl  +  a*u 


kk 


- 


(2.8) 


where  <r*  in  th*  observation  error  varlanoe,  r  and  s  refer  to  variable  label*,  tb*  +  and  -  superscripts 
refer  to  after  end  before  systsa  correction,  end 


£ 


"rk°k 


Furthermore,  Ap,  is  defined 


Rpt  *  °ps 


(2,9) 


r  -f.  .t ^ 
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It  nay  be  proven,  from  the  fora  of  the  Kalnan  correction  formulae  presented  above,  that 


| 


X  r  >  K» 

"re  8  arkAk.  ■  »  <  g 

Br«  1  °rs  “  ^  Rtkffk»  1  •,  r  >  K 

undergo  oheugee  under  system  correction  ARr>  =  0  ,  Asrl  -  0  ;  that  le,  Hft  ,  8r>  are  correction  lnvariente  for 
the  oboeen  invariant  sot  (position).  Note  that  the  ‘nvarianta  aro  not  functions  of  the  observation  weights  (Qk) 
nor  observation  accuracy.  In  particular,  it  Is  seen  that  Invariants  for  any  position  observation  components  are 
the  seas.  It  can  be  shown  that 

AAps  =  °p°»/oe  ,  p  ,  s  <  K  .  (2.  10) 

The  orror  propagation  of  ,  g  ,  g  may  bo  expressed  dlreatly  by  differential  equations  In  terms  of  A  ,  K  ,  3 
alone.  The  Kalman  system  corrections  have  weight 


q  ?*««• 


a.  id 


where  U*  s  ipOpA;‘ 
observations, 


hr  the  case  where  the  correction  invariants  aro  defined  with  respect  to  position- type 


sp 


A'1 

"eg 


ASI  '*11 

Zhl _ iu, 


AnAt 


This  Implies  that,  upon  receipt  of  a  position  fix,  dnly  the  A  matrix  (3  elements)  need  be  updated;  the  R  and 
8  aubaatrioee  (39  elements)  are  Invariant,  and,  hence,  do  not  change,  An  abbreviated  proof  of  A  ,  R  ,  8 
properties  follows: 

(a)  The  correction  formulae  for  Ap,  defined  with  reepeut  to  a  seleoted  observation  type  are  obtained  from 
the  ordinary  Kalnan  formula  for  that  observation  type  after  taking  the  first  difference  of  the  identity. 


Thus 


Apk°kr  *  °pliffkr  =  *p  • 


P  ,  r  ,  k  ,  <  X 


^pk^kr  +  Apk^kr  =  0 

AApktrkr  -  Aikukuiycrl  *  0  • 


(3. 13) 


where  a  summation  convention 


obtain 


la  used  on  paired  indices.  Multiplying  by  (ojj)*  and  noting  that 
*  °pr^r  °  V,.°.  »  °p  ■  »  <  *  • 

A*p,  -  A'nUilljAjV^  »  0  , 


(3. 13) 


whence  the  correction  formula 


AAm  a  — ,  p  ,  I  <  K  . 

*  °r 


(3.  14) 


(b)  The  invariance  of  R_8  defined  with  respect  to  a  selected  observation  type  le  shown,  taking  the  first 
difference  of  the  defining  equation  for  R  , 


ARre  s  ^rkAks  ♦<7?kAAks  [  ^  <  g  , 


(3. 18) 


Substituting  the  ordinary  Kalnan  correction  and  the  AAp,  expressions 


ar„ 


a  -"r^A*  +  (7-  V. 

-^-Aks>-rk-|-  ; 


(3.  18) 


and  using  Equation  (3. 13)  and  the  definition  of  Ur  , 


These  restrictions  ers  rsduodant;  e.e.i  ell  8  invariants  ars  sero  »h»re  position  is  involved,  end  R. 


Aft, 


a»  ■  °6 


0  , 


Htnct  ftr,  la  invariant, 

(s)  Tha  invarianua  of  S_,  daflnad  with  roapact  to  •  aalaotod  obaarvation  typa  ii  aiiown  by  taklni  tha  fine 
diffaranoa  of  tho  dafltilna  aquation,  ualni  thu  eolation  ARrk  a  9  , 

Aflrf  -  Airri  -  Rrlt  Aotn  '  ‘  <*17> 


and  than  aubatltutint  tht  ordinary  Kalian  axpraaalona  to  obtain 


AS, 


-u:ui 

+  Rrk 


u;ui 


-i  K  ♦  KM 


using  Rl.  ■ 


K» 


■ubatltutlni  tha  daflnim  axpraaaion  for  Rfj( 


*rVk  ”  ^ipApftO;  ■  *nV  »  -» 


Hanoa  ASr|  «  0  ;  that  la,  «r(  la  oorraotion  invariant  ralatlva  to  tha  aaaoolatad  typa  of  obiarvatlon. 


I.G  Oorraotion  Fornulaa  for  Diaparata  Obaorvationa 

Tha  oorrastlo'n  Invariant  aat  for  obiarvatlona  8  (involvln*,  far  txanplo,  poaltion  arrora)  art  not  invariant  ' 
undar  oorraotiona  with  dlffarant  klnda  of  abaarvationa  (auob  aa  involvini  valonity  or  aaiiuth  arrora) ,  Tha 
.foUonUw.  lB  .a  .derivation .of  oorraotion  fornulaa  lor  diaparata  obaorvationa,  which  ara  ahown  to  ba  oloaaly  aialllar 
to  ordinary  Kalian  fornulaa  but  in  tha  variablaa  of  tha  oorraotion  Invariant  aat.  Tha  alitbralo  darlvatlon  diffara 
for  unaaaoalatad  obaorvationa  aa  a  raault,  In  Equation, (3, I)  tha  taraa  U(  -  U,  abort* 


ur  *  orra°a  •  •  <  K 

Ur  «  »r,0,  ■  «  >  * 


(J.  i«> 


That  ia,  q  lo  not  in  tha  aat  of  variablaa  for  which  Ap(  la  daflnad.  Conaaquontly,  (irAr|  t  ar  and  Equation  (3. 14) 
doaa  not  bold.  Indaad,  for  tba  unaaaooiatad  obaorvationa  tI_Ati  ■  o-r,a.Art  *  9QA?i  t  ft,t  ,  wbtrt  r  la  tha 
oorraotion  lnvarant  att  of  tho  ooaputatlon  prooaaa  and  danotlu  Ry,  =  a^#1  for  8  diaparata  typa  of  obaarvation. 
Tba  Equation  (3. 10)  it  raplaoad  with 


•awp^rwa 


(3,  IB) 


riiloh  la  a  fonula  couputationally  alallar  to  tha  ordinary  Kalian  fonula  aicapt  for  aim  of  tba  oorraotion,  Tba 
oorraotion  Rr|  tor  unaaaooiatad  obaarvation  typa  u  ohtalnad  froi  tha  R-aatria  dtfinini  Equation  (3. 13)  and 


Atr, 


rk 


-*'K 


(3.30) 


Purthar  aanlpulatlon  ylalda  tha  oorraotion  fonula  for  Rri  with  unaaaoolattd  obaarvation: 


Aft  n  ~****ar»*  r  >  K 

oj*  a  <  K  . 


(3.31) 


Tba  iapliad  ooiputatlon  ia  dlractly  analofoua  to  tha  ordinary  Kalaaa  oorraotion  fornulaa. 
Tba  oorraotiona  of  8rl  for  unaaaooiatad  typaa-ia  obtainad  in  tha  aaaa  nannar. 
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The  eorrkctlon  formula  for  unasaoclatud  types  of  observations  i« 

* 

Afl  _  S  -  whsre  r  ,  a  >  k  . 

Tha  iaplled  computations  are  wain  directly  nnalogoua  tn  the  ordinary  Kalman  corroctiun  formulae. 

3.1  Computational  Feature!  of  Correction  Invariant* 

The  Kalian  filter  inn  oomputatlona  relating  to  error  growth,  when  exeouted  in  correction  invariant  variable*, 
hav*  a  number  of  markedly  different  characterlntioi  from  the  direot  form  with  impact  on  oomputer  coat,  inoludina 
effeota  of  th*  following: 

(1)  Obviation  of  the  bulk  of  the  error-matrix  update  oomputatlone  following  inertial  eyitum  correctlona  with 
aid  data,  thle  being  the  consequence  of  the  invariance  proport  tea.  Thle  feature  makes  a  wired  incremental- 
ooieputation  program  of  digital  differential  analyzer  program  attractive  btcaute  of  eubitantlal  reduction 
of  memory  requirements  associated  with  instruction  memory,  the  variable  memory,  however,  being  inoreaied 
to  a  leaser  degree. 

(II)  Reduoed  word- length  requirement!  and/or  dacreaaod  computation  error  sensitivity. 

(a)  Tbe  bulk  ot  the  variable*  in  the  aorreotion  invariant*  computation!  hav*  readily  determined  variation 
range*  which  change  little  for  dliparata  flight  and  aid  data  profile*.  In  oontraet,  variance*  whloh  hav* 
the  range  of  th*  iquar*  ot  error*  which  themeolvei  hav*  wid*  rang*  are  unwidely  computationally  and  can 
require  aoultoring  to  prevent  overflow  under  varying  operational  condition*, 

(b)  The  A  eatrlx,  whloh  oompriie*  th*  eaall  portion  of  non-invariant*  ot  the  computation  aet,  li  functionally 
th*  inveri*  of  a  partition  of  tha  arror  matrix  and  a*  suoh  has  diagonal  taraa  whloh  vary  proportionately 

to  ayataa  aoouraoy,  whloh  liaa  hatwain  aaro  and  a  sharply  defined  upper  band.  In  oontraet,  th*  dlraot 
arror  quanr.ltle*  are  relatively  unbounded.  Useful  information  la  beet  mapped  in  terns  of  aoouraoy  maaaur* 
in  atatletlos  for  combination  with  other  information.  (Thua,  defining  aoouraoy  A  s  l/o*  ,  whara  o'  la 
th*  variance,  it  follow*  that  th*  aoouraoy  obtainable  by  many  observation!  1*  th*  eum  of  aoouraoy. ) 

(o)  Th*  R  invariant*,  which  appear  in  the  Kalman  waighting  tor  inertial  lyatem  trim-up,  have  functional 
behavior  of  ratios  of  related  variances.  Th*  retint  have  relatively  limited  rang*  compared  to  related 
oorrtiatlon*. 

.(4)  Th*  •  Invariant*  (ooaprlsing  tha  larger  part  of  modified  matrix  equation*),  whloh  oorraapond  to  correla¬ 
tion*  of  non-obacrvablta,  era  th*  moat  Inaanaltlv*  to  aid  data  profile,  offering  a  potential  of  extensive 
aemory  reduotlon  by  approximations  whloh  do  not  materially  oompromia*  performance  optimality. 

(III)  Memory  saving  by  reduced  computation  program  relating  to  oroee-ohanntl  inertial  variable  correlation*. 

The  correction  Invariant*  tend  to  retain  tha  simple  croaa-ohannal  characteristic*  of  the  pur*  Inertial  system, 
otherwise  disturbed  by  th*  tldlni  process,  whloh  are  principally  th*  reault  of  aslmuth  error  (and  latitude  error 
entering  earth  rats  estimates  to  a  usually  smaller  degree).  With  computation  in  invariants  form,  it  has  baen 
demonstrated  that  a  30-40%  reduction  in  difftnntial  equations  programing  la  fasaible,  th*  obviated  equation* 
being  replaced  with  a  few  oloaed  form  eciauthal  correlation  ralationi  whloh  enable  oapeblllty  for  aslmuth  correc¬ 
tion  baaed  on  aooeleratlv*  effects  (important  at  high  latitude*). 


3.  SVITIN-KRROR  MODELS 

The  basic  error  touroee  aoneidered  are  characteristic  of  the  inertial  sensuri  (gyroa  and  accelarometera)  and 
■laallinaenta  of  these  sehsora.  Random  arror*  whloh  are  dciorlbtd  by  statistical  autocorrelation  function*  were 
considered  tor  th*  eeneora.  Theee  error  model*  ere  described  in  sore  detail  in  th*  subsequent  notion*.  A  north- 
■oeklng  coordinate  tram*  la  aaaumel  with  th*  axea  orientation  ohown  in  Figure  1.  (The  inertial- eyetea  error-modal 
block  dlegraa  ia  ahoeo  later  in  Figure  5.) 

A.  1  Inertial  Renaor-Crror  Models 
3.1. 1  Ctrural 

Tha  laartlal  eenaor-error  models  are  oontalned  in  th*  general  IMU  error  modal;  bowaver,  a  brief  deaorlption  i* 
presented  bur*  to  olarify  th*  aodela.  In  th*  deecription  of  th*  various  genaorg,  th*  noise  function  considered 
1*  exponentially  correlated  with  an  autocorrelation  funotlon  of  th*  fora 

R(f>  m  5,*"l'|ri  , 

where  0'  1*  th*  nolae-amplitud*  funotlon  and  v  is  th*  reciprocal  of  th*  correlation  time  characteristics  of 
th*  noise.  Non-whit*  noli*  drlvlni  funotloni  of  thla  nature  are  generated  by  drivlns  a  ahaplna  filter  with  white 
noise  having  an  autocorrelation  function 


R'(t)  u  2v0*S (t)  . 
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!r  . 


f 


I 


\ 
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Tb*  shaping  filter  ii  ehown  in  Figure  1. 

No  thermal  model!  nr*  ooneidered  (or  the  Inertial  Instrument*. 


3,1.3  Asciltroittn 

Brrore  which  are  oharaeteriatlo  of  the  eocilsrometera  in  title  mialyoii  are  biaa,  random,  icale  factor  and 
non-orthoaonalitl**.  Biaa  le  defined  ae  day-to-day  or  long-term  repeatability  and  ii  aaaumed  oonitant  over  any 
■iaalon,  foale-factor  error  refera  to  calibration  errori  and  loni-tera  it  ability  of  the  aooelerometer  ainaing 
mechanism  (including  electronic*).  Thla  error  i*  assumed  conetant  for  the  flight  duration.  Random  ia  a  short- 
tera  change  due  to  ahlfte  in  the  acoeleramater  biaa  and  aoale  factor  error*.  Non-orthogonalitle*  are  eompoeed 
of  two  baale  error*  -  mechanical  diaallgnmcnt*  in  counting  the  accelerometer  and  mechanical  mlealignment*  internal 
to  tha  Mcalaroneter, 


3. 13  Gyro i 

Tha  gyro  terminology  employed  le  in  genaral  conaiitent  with  the  etamJard  gyro  terminology  prepared  by  tha  Qyro 
and  Aooelerometer  Panel  of  the  Electronic  Parti  Coamittee,  Aoroepaot  Industrie*  Aaaooiatlon.  The  error  eouroea 
ooaaldered  are  aoaileration-lneeniltivi  biaa  and  random  drift*,  acceleraUon-saneltive  drift*  (mane  unbalance  and 
oompliaaae  or  anieoelaetlolty),  torquer  eoale-faotor  error*  and  meohanioal  mlealignmenta. 

Tha  biaa  error  la  aaauaed  conetant  ever  any  ilaaion,  elnce  it  la  defined  at  the  day-to-day  or  turn-on 
repeatability,  The  random  drtft  ie  deiorlbed  by  an  exponential  autocorrelation  function  and  don  change  over  tny 
liven  aittlon.  Torquer  eoale-faotor  errori  are  due  primarily  to  electronic!  and  nalibration  error*  and  remain 
conetant  over  the  million,  Mechanical  aliallgnnente  are  eompoeed  of  gyro-mounting  errore  and  internal  gyro 
non-orthogonalltlaa. 

Tha  differential  equation  deaorlbing  the  gyro-noiae  model  to  be  uted  in  tb*  Kalian  filter  la: 


•her* 


J.i.4  Dopplir-Crror  Modtl 

Tb*  Doppler-error  model  alaulated  i*  eompoeed  of  eeverel  error  type*,  which  are  ehown  in  Figure  3.  The  error* 
ooneldered  are  bore-eight,  icale  faator,  high  frequency  eleotronioi  noieo,  low-frequency  terrain  (overwatar)  nolae, 
oonvereion  blue*  and  flexure  errori.  Tb*  baelc  differential  equation  deaorlbing  the  Doppler  noli*  model  lm 


(  ■  DC  «  e  +  CKD  «  8J  , 

*5 


1  if  T  u  | 

0  if  r  i  I 


DO  ■  — 


t,  ■  correlation  time  of  gyro  noli* 


CKD*  * 


**  x  00 


«  *  gyro  random-drlft-rat*  aeplitude  . 


5 V,  *  BB  x  SV„  +  CKA  <  S' 


if  t  ■  B 
if  r  i  ■ 


BB 


Tj  »  Doppler  correlation  time, 


Mao,  aboen  in  Figure  4  le  the  resolution  of  the  Doppler  velocity  through  platform  heading  and  drift  angla 
into  platform  aaia  oomponenti.  The  eymbole  JVt  and  5Vy  repreaent  the  dlfferenoea  between  platform  veluoitiei 
<VM.VM)  end  the  reepeotive  Doppler  velooltiee. 


1.1  MU  (rror  Model 

Tha  1MU  error  model  la  ahowu  in  Figure  S  wltb  each  axia  decoupled  plotorlally  but  functionally  coupled.  The 
level  nhinneli  are  completely  shown  in  the  fieurw  with  only  the  vertical  gyro.  The  vertical  loop  is  not  presented 
because  a  conventional  third-order  baro- inertial  loop  ia  aaaumed;  iienoe,  the  verticil-velocity  error*  are  email. 


-rw 


function*  dMcrlbing  tioh  of  tb*  trror*  in  praaantsd  and  dltouaatd  btlow,  and  taminology  1*  eonilitant  with 
that  tBploytd  In  *»it  fuldanca  text*  and  that  apacifiad  by  tht  Oyro  and  Accalaronatar  Pantl  of  tha  Elaetronio 
Parta  Comlttaa,  Aaroapaca  Induatrtn*  Aaaociatlon. 

Corioli*  Error i 

sc,  =  -«(/>„  tan,)v„  -  (pi+  an,)vy  . 

8C,  *  s^+srgv,,  t  (p,  +  2n,)Vx  . 

Crott-Couplinf  Acc«  Urol  ion  l Trror* 

M*>X  =  r 

Acc9 leromi ttr  Non-orthogonalititM 

=  *•  +  ^gAj 

*|$>Y  ■ 

Aeeihromlir  Noil*  and  Biot 

^Ja"*'lTl  +  7X 
0{f‘'lrl  +  V,(  . 

Acc*  !«ro«ft*r  Scalt-Factor  Error 

Wkx  a  X  aaoalaroaatar  acala-factor  arror 
8Plt  i  a  Y  aooalaroaatar  acala-factor  arror 
A„  ,  A,  art  trua  anoalarationa. 

CoopoiaUunal-Error  Bain 

lpt  •  -  V,/X 

■  +  n  •la^Sd'x 

TPN  ■  dyro  tomulm  tan  frog  filter 
tpx  *  V„/A 

V  V 

ipt  ■  tao  0,  Ji  +  J2  aao'i^,  &<px 

14  R 

Sfiy  =  flooa'P80T  *  #lg  . 

Gyro  Noil I  o rul  Mot 

yj  a’*lTl  +  *„  • 

y*  a^lTl  +  a, 
y*  ,-/|r|  +  tg  , 

Gyro-Scali-Factor  Error 

fftg  a  aoala- factor  arror  lo  X  gyro 
a  Mala -factor  arror  in  Y  gyro 
a  acala-factor  trror  In  Z  gyro  . 


Gyro  Crou-Couplinf  flat** 


«!<")*  =  -•“rA  +  a'iA 
«l(S),  a  -  tu!Td»x  +  “,A 
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Gyro  flon-orthogonalit («» 

hi<If)x  '  -  Ms 

■  h^Hx  -  k|ltg 
h t (K)  t  ■  kjA,,  -  k,Rr  . 

Gyro  Acctloration'Seruit  ivi  Erron 

(4)  )j  *  —  AyCj  +  AjO,  —  A^A^O,, 

f , (X) y  *  AyOj  -  AgCf  +  AjjAjC,, 

E  “  AXC,  +  AjCj  f  A^AjC,)  . 


3.3  Environmental  Module 

Obaervatlons  mads  by  the  tirborua  Duppler  sotuior  Art  relative  to  tht  sun,  wtt J nh  contaminates  the  obeervetlon 
with  tbrto  basic  error  component!,  Tbeee  component!  fell  in  three  categories:  wuite  nolle,  shart-tsro  end 
long-ters  eorreUttd  nolle  with  eutoeorreletlnn  functions  of  the  form  deeeribed  in  Beotlon  3.1  (Figure  3).  The 
whlte-nolse  component  reeulte  from  white  onpe.  The  ihort-term  aorreleted  tee  current  oen  be  oherecteriied  by 
oorreUtian  dietaneee  of  IB-30  neutlcel  miiei  with  nominal  amplitude!  of  0.4  to  1.0  Itnota,  The  loni-term  . 
correlated  nolle  hai  nominal  amplitude!  of  3  knota  with  correlation  diettnoee  on  the  order  of  BOO  nautioal  lilee. 


4.  IT  ATI  VAR  I AB  LE  •  SELECT  I  ON  •  AND  >  CO  V  All  1 ANCE  •  MATRIX 
PROPAGATION 

4.1  State  Variable-Selection -end-Defining  Equations 

a 

Due  to  phyeloal  oonatriinti.  euoh  ae  computer  program  lime  and  proteaiing  time,  a  fully  optleliad  Kalian  filter 
■uohaniiation  ii  virtually  impoaulble  for  an  airborne  oonputer.  Hsnoe,  luvaral  trada-offn  luet  be  auula  In 
eelaotini  a  euboptlmal  filter  which  will  offer  the  advintaiea  available  from  in  optimal  filter  and,  yet  ilnimlae 
the  drawback!.  The  eeleotiun  of  the  itate  varliblea  which  adequately  deiorlbe  the  ayatei  le  the  noit  prominent 
area  for  trade  atudlea  with  aomputer  reitrlotlone  in  mind.  The  itate  variable!  ehuuld  include  all  the  quantum 
required  to  deiorlbe  the  condition  of  the  eyetem  end,  whin  possible,  its  significant  error  contributors,  elnoe 
then  error  contributors  can  be  reduced  with  the  aid  of  the  optlaal  filter.  The  desree  of  optimality  le  dependent 
on  several  factors  auoh  as  eoouraoy  in  the  deaoriptlon  of  the  error  model,  proaoesins  techniques  and  selection  of 
the  state  variables.  The  states  of  the  Inertial  eyetem  which  improve  thu  performance  accuracy  when  aoourately 
modeled  am  position,  velocity,  platform  tilts,  and  platfora  heading.  System  performance  aoouraoy  is  improved 
considerably,  also,  if  tbs  principal  contributors  to  the  errors  in  each  of  the  above  states  can  be  modeled.  The 
inertial  system  as  presently  modeled  for  the  alignment  and  navigation  modes  has  41  dominant-srrur  souroas  nop 
including  the  effects  due  to  aid  eeneora,  computer  or  environment.  Beoauee  many  of  these  errors  contribute  only 
eeoond-ordir  effects  (even  In  a  conventionally-duped  system),  it  le  neanlngless  to  Include  these  as  state 
variables.  This  reduces  the  number  of  significant  error  louroes  to  basically  the  bias  and  random  error  components 
of  the  gyros  and  accelerometers. 

Prior  to  the  final  selection  of  the  statue,  one  must  also  examine  the  aid  seneorn  available  to  the  eyetem. 

If  the  errors  Induced  by  utilization  of  the  aid  eeneora  are  clgulfloant  as  cosgmred  to  the  itate  variable 
aandidatee  mentioned,  then  the  eld-sensor  contributions  must  also  be  considered  as  possible  candidates.  For  the 
present  epplication,  the  Doppler  performance  specification)*  are  assumed  sufficiently  large,  suoh  that  the  Doppler 
error  la  one  of  the  primary  error  contributors  tu  thn  system  performance  acoursoy  and  must  be  considered  along 
with  the  gyroa  and  acoilirometara. 

In  performing  the  final  system-trade  studies  tor  state  variable  selection,  the  inertial  lessor  and  aid-senior- 
error  sources  were  weighed  against  each  other,  Although  the  level-socelirosete'r  bias  and  random  errors  are 
primary  contributors  In  system  aoouraoy,  the  level  accelerometers  were  eliminated  as  stats  variables  since  the 
reference  veloolty  error  was  so  large  in  comparison  to  the  inertial  system  error  attributable  to  tbs  accelero¬ 
meters.  In  fact,  in  the  present  aeohaniaation,  the  Inertial  system  is  used  to  trim  the  Doppler,  As  a  result 
of  the  trade  studies,  the  level-gyro  drifts  and  two  boppler-velooity  states  wars  added. 

ieveral  other  errors  ware  considered  as  possible  state  variables.  Thee*  were  vertical  gyro  drift,  gyro  torquer 
scale  factors,  accelerometer  aoals  fsotors,  and  vertical  accelerometer  bias,  In  tbs  vertical  cbsnnel,  tbs 
sooeleromster  is  not  compensated  by  the  filtering  te.bnique;  however,  the  vertical-channel  error  is  minimised  by 
the  baro-inertial-loop  mechanization.  The  azimuth-gyro  drift  is  a  large  contributor  to  the  system  position  error; 
however,  to  esplioitly  model  this  .as  a  state  did  not  Improve  system  accuracy  to  ths  extent  to  wsrreut  seohsnlsiug 
sa  additional  state.  Instead,  the  sslauth  ayro  Is  modeled  as  a  "pseudo-state"  by  Incorporating  ite  approxlaats 
affeota  aa  a  noiae  on  tho  platfora  heading  error  aquation.  Siailar  rational*  was  employed  In  sllsinstlng  the 
lsvel  sooeleromster  errore  as  stats*.  In  th*  Interest  of  maintaining  th*  ooaputational-losd  minimal  and  in  th* 
trada-off  of  computer  capacity  rsqulred  vsrsua  improvement  In  nsvigntlon  acoursoy,  tbs  remainder  of  the  error 
sourosa  were  eliminated. 
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ForMlljr,  Litton  tiu  aalaotad  tlnwn  atate  varlablaa  to  nodal  tha  ayatan: 

4>  ,  JXaoa0,  latitude  and  aaat  poaltlon  arrora,  reapentlvely 

JVN  ,  jv,  platforn  north  and  aaat  axla  velocity  arrora,  reapeotlvely  (VrV,) 
dij  ,  ,  0,  aniular  arrora  In  platforn  tilt  (0g  and  0„)  and  anlnuth  anila,  raapaotlvtly 

ng  >  «N  platforn  level-gyro-drlft  rataa,  aaat  and  north  (tx  and  ty)  , 

Tba  atata-varlabla-daflnlnv  aijuatlona  eorraipondlni  to  thaaa  atataa  tor  tha  north-aaaklni  coordinate  ayatan 
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vertioal  ooaponent  of  earth  rate  (e  n»in$,) 
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,  V,  a 

plnttora  ooaponent  of  craft  voloolty 

an 

.  A,  « 

north  and  aaat  oompnnente  of  platform  aooalnrution, 
raapcotlvely. 

^Nnte,  this  can  ulao  be  computed 

-■ 

by  =  T**')  tor  'a*11  At 

At  At  / 

Ra 

'  Ra  = 

radii  from  oenter  of  earth. 

Bupereoripta  H  and  8  refer  to  hardwern  and  aaa  component*,  reapectlvely,  and  the  wt  terma  are  tho  dementi 
of  the  Internally  genoratad  nolaa  matrix.  The  laat  four  defining  equations  define  the  Doppler  and  g.yru  atatee. 
Note  that  a  flrat  order  lag  nlmulatlon  model  la  uaed.  from  the  above  actuation!)  the  F  ,  0  and  »  mutrlooa 
referred  to  In  Kalman' a  work*  can  be  written. 

The  2t  •  C  .  S  8Qd  w 
•tatea  and  [  ,  fl  and  g 

■atrioea  are  ahown  In  Table  11.  The  atata  variabla  matrix  la  oomprieed  of  the  eleven 
aatrldea  nan  be  written  by  lnepeotion  of  the  atata  variable  defining  eciuatlone. 

TABLE  11 

J,  (,  1),  and  w  Uatriota 
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4,1  CovirUti'-'j  Matrix  computation 


The  oi  .riinc*  matrix  and  Kalman  lain  computations  form  the  bulk  of  the  computer  program  to  bo  mechanized. 

This  lection  iddreiies  tho  oomputatluna  roqulrod  to  propmata  tho  covarlanot  matrix.  Aa  previously  stated, 
the  covariance  matrix  la  a  running  sstlmnto  of  the  system  perrormanoe  and  henoe  the  ability  to  predict  and 
correct  the  system  Is  totally  dependent  on  the  exaotnosa  of  this  matrix,  Retarding  one  aspect  in  programming 
the  covariance  matrix,  the  technique  employed  in  propagating  the  matrix  over  time  and  computational  exactness 
uust  ba  investigated. 

Litton  bee  ohoaen  to  use  direct  Integration  of  the  oovariwio*  matrix  which  waa  derived  on  a  continuous  basis. 

In  keeping  with  the  accuracy  requirements,  a  higher-order-intigraUon  algorithm  waa  found  neccenary.  Litton  la 
currently  ualns  a  product  of  verlnbles-typo  algorithm.  Thii  algorithm  It  preeunted  In  more  detail  in  the 
following  section, 

In  the  interest  of  minimizing  computer  requirements  and  maintaining  good  performance  accuracy,  trado-offs 
performed  on  the  various  elements  of  the  covarienoo  matrix  resulted  in  aegmentlng  the  matrix  into  two  mnjur 
computational  parts.  Those  major  subdivisions  wore  based  on  the  rste  of  chango  of  the  oovarlnnce  matrix  olomonts. 
As  s  result,  the  covariance  matrix  Is  composed  of  "fast"  loops  and  “slow"  loops,  The  significance  of  those 
loops  sro  that  the  fast  loop  components  vary  quite  rapidly  and  posaesa  a  wide  dynamic  range  compnrud  to  the 
alow  loop  computations.  Here,  dlrsot  Integration  of  ths  slow  loops  tt  ths  tame  rats  as  the  fast  loops  would 
rssult  In  a  mors  coarse  estimation  in  that  round-off  effects  would  b*  mors  pronounced,  Therefore,  to  maintain 
computational  praolalon,  ths  alow  loop  processing  Interval  la  approximately  go  tlmos  the  fait  loop  prooeasing 
Interval. 

Figure  6  illustrates  ths  notatlonsl  convention  and  th*  members  of  tho  covariance  matrix  that  are  computed. 

Where  blanks  appear,  the  matrix  elements  are  computed  by  their  closed  form  approximations  If  these  elements  ere 
needed.  Ths  notation  used  is  a  capital  latter  A  ,  R  or  a  to  indioata  that  the  element  Is  s  member  of  thst 
•ubaatrix.  The  subscripts  on  these  elements  define  th*  stats  variables  which  are  statistically  correlated  by 
thst  function,  e.g, ,  S|i#)  is  tho  8-mutrix  covariance  of  x-axis  vslootty  (x)  and  y-axis  platform  tilt  ($y)  . 

Ths  cover lanos-satrlx  element*  which  srw  lift  blink  in  Figure  S  are  not  computod  explicitly.  If  they  are 
needed  In  propagating  other  (laments,  they  are  computed  from  closed  form,  orose-ohonnel  correlation  formulas*, 

This  allows  computing  of  only  43  nt  ths  08  elements  of  ths  aovarinnon  matrix, 

4.3  Integration  Algorithm  (for  Filter) 

Ths  programmed  Integration  algorithm  is  one  designed  to  correctly  Integrate  s  product  of  two  variables  with 
constant  rates  of  change. 

The  algorithm  should  oomputs,  from  t  ■  0  to  t  *  At  , 

**  *  f  *,dt  ■  c  <y0+yst)<*o+»ot>  dt 

■  [y0«„  +  <y,mc+i0y0)(At/3)  +  y#*0  (At'/3)3  At  . 

Consider  an  algorithm  whloh  utilises  the  computer  value  for  tha  prsoedlng  increment  in  the  oomputet<on  of  the 
prement  lnarsnant.  Auum*  the  elgorlthm  is  correct  for  variables  with  constant  rats,  so  that  ths  o. imputed  value 
of  the  prsoedlng  Increment  Is  equal  to 

AJ0i„  «  [»,«,  -  (i.ij+V^lAt/a)  ♦  *„*„  (At'/3)]At  , 

Let  the  algorithm  tn  ■  ths  form 

AJ  «  nAJoU  +  (l-t))<yold+MAy)  (zold+MAz)At  , 

where  y  ,  (i-y)  salghti  art  Implied  by  the  Dsositlty  of  cucvuttcg  ccrrsotly  tor  ctro  rats  variables  expressing 
AJ  In  tsrai  of  y,  ,  i,  ,  4,  . 

AJ  »  c?Ly#m( -(#„», +4^,) (At/a)  +  3r0m0<At'/3)jAt  +  (l-T))(y0  +ju#„At)(m,+pi40At) At 
«  jy,g,  +  <M<  1-^1)  -  -ry'3>C#0*o  ♦Vo)  +  +  ( 1  ■  T))MI j# 04,At At 

«  ty,l0  +  0,^,1,,  +  *^,)  +  C^jAjAt'lAt  . 


*  Tbs  closed  tors  reletiaoabips  utilise  invariant  product!. 


Hr  correctnees,  tho  linear  and  quadratic  coefficient!  0,  and  C,  nut  be  1/2  end  1/3,  raapoctively,  Henoi 


take 


which  flVH 


An  epproximete  eolutlon 

lmpllee 


nU-i))  -  rj/2  •  c  1/3 
V3  +  <l-t))|*J  =  1/3, 

M  =  1//3  =  0.877 
3  -  i/3 


7)  * 


e  0.0118, 


2  +  /3 

7)  ™  2"1*  ,  M  =  (3‘ 1  +  J'") 

H1-'’)-  "*  ■  s-E-s  (i*s)]  ■ 


which  might  be  adequate  If  dealred. 


The  lenerel  form  of  error-propagation  aquation*,  Including  the  invariant  form,  involvee  the  eumuetlon  of 
diepermte  terrm  to  obtain  eeoh  integrel  increment  of  e  beelo  variable  during  g  program  cycle. 

The  oouputttlon  •cheme  te  iteted  lnplleg  the  etorege  of  42  quantitiaa  tech  foi  old  veluei  of  integrel 
lnoremente,  -for  interpolated  veluea,  end  for  Integrated  atate  verieblee.  Thle  totele  128  worde  of  etorege  for 
the  Integration  algorithm.  Thia  le  84  worde  more  than. the  almpledt  natural  algorithm. 

floneldar  algorithm  computational  requirement!  for  inltielimitlon  and  inertial  eyatem  correction  where  the 
old  eetlmatea  of  the  lntugral  lnoremente  muy  not  be  uvulluMe.  ‘One  approach  la  to  add  a  cycle  of  the  increment 
nompututlon  where  there  le  no  accumulation  af  the  integral,  and  thereafter  return  to  the  normal  program  tor  the 
flrat  Iteration,,  ualng  m  *  1/4  ,  rj  a  2/3  .  Syatem  correction*  with  the  Doppler  radar  are  programmed  aa  a 
quaai-oontlnuoua  proooaa  in  which  their  effect*  in  error  intimation  are  part  or  tlu  eteady-atate  integration 
proceaa.  The  poaltlou  flaaa,  however,  raqulra  an  lnltlligation  proviaiun  to  account  for  atep  ohangea  In  the 
ddrlvatlvea  of  A  and  R  matrix  verieblee.  Thle  nay  be  aoconpUahed  with  th*  pneudo-oyole  computation  with 
H-  D  1/4  ,  V  *  2/3  or,  if  it  ia  found  that  inltliliiation  after  dead  reckoning  with  Doppler  can  be  tolerated 
without  a  pceudo-eycle,  the  piaudo-o/ola  oan  be  obviated  altogether  provided  the  atepa  in  a  pueudo-old-incrament 
of  A  ,  It  for  poaltlon  fix  are  computed,  Then  incrementa  are  computed  by  foraula*  derived  by  lnoramentlng  the 
difference  equetionn  for  error  growth  of  4,  ft  ,  for  incrementa  of  A  on  fixing,  The  additional  computation! 
involve  18  multiplications, 


4.4  implementation  of  Invariant* -Moating  Technique 


B 


In  Implementing  a  aoallng  algorithm,  "real-world"  conatralnta  dictate  eeveral  of  the  limiting  oondltlone 
aeohenlaed.  For  lnetance,  aeparate  acalea  are  needed  for  verloua  minion  phaaea;  however,  to  fix  a  dlatinct 
aet  of  acale  factor!  obvlouely  Impoeea  ayateia  conatralnta  and  theae  conatralnta  lead  to  the  development  of  an 
adaptive  reaoaliug  module.  The  reacaling  module  would  be  axercieed  at  the  beginning  of  eaoh  filter-updating 
oyole,  The  auooeaaful  implementation  of  tlila  reaoalini  technique  relie*  on  th*  regular  bahavlor  of  the  elemenu 
of  the  covariance  matrix.  A  large  ohxnge  could  coour  In  then*  eleaenta  if,  fur  lnatanoe.  a  poaltlon  ubaervatlun 
1*  mad*.  If  th*  Incremental  change  In  theae  elegante  ie  too  Urge  to  be  accomodated  In  one  filter  oyole,  a 
"aagmentad"  fix  can  b*  aaally  aechanUed  *0  aa  to  avoid  reglafcer  overflow  or  constrain  maximum  information  by 
laft-ahiftlng  if  th*  quantity  being  updated  ia  rapidly  deareagini. 


In  lapleientlng  the  reacaling  module,  the  philoaophy  la  to  tut  the  diagonal  element*  of  th*  ouvarUmi*  matrix 
and  to  constrain  th*  scaled  quantitlee  to  lie  within  t  iputufied  range  of  the  register  by  controlling  the  acale 
factors.  With  the  ahuaen  conatralnta  aaohanlaed,  the  readailng  loop  ahifte  left  or  right  by  ona  bit  if  tha 
reacaling  taata  fall. 


4.4,1  JnllioUiolion  Sailing 


For  tha  aoallng  of  tha  program  paramatara,  all  of  the  acale  faotori  are  formed  from  baaloally  alx  faotore, 
Wd)  through  «F(8).  The  nuaarioal  value  In  parentheeia  refer*  to  the  type  of  paraaetvr  being  coaled,  e.g, , 


« r  (i) 

V  (2) 
1  V  03) 

•F  (4) 

W  (»> 

UF  (8) 


poaltlon 

velocity 

tilt 

gyro  drift 
Doppler 
ealmuth  . 


,>  , 

v_v, 


.in.:. 
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At  time  aero,  value*  far  enoh  of  the  ecalo  faotora  arc  lelected. 


The  element*  of  tho  oovarianoi  matrix  o»n  be  eoaled  by  Implementing  the  equivalent.  to  the  following  FORTRAN  DO 
loop, 


DO  44  I 

* 

1,  5 

DO  44  J 

= 

1,  s 

6FP(I,J) 

Bf 

i/s'  (»/s  (J) 

X(I.J) 

= 

SFP  (1,J)* 

Xd.d) 

44Y(I , J) 

2 

SFP  (1,J>* 

Y(I, J) 

Boallni  of  specie!  funotlone  et  time  zero  In  performed  Hepuratoly. 


All  pnremotere  muet  have  an  aeaigned  lulling  bufere  tlielr  Insertion  Into  tho  program;  however,  tlile  la  not  a 
drawback,  elnoe  tho  olionen  parameter*  in  the  f  1  It  or  program  oan  be  reeeuled  at  will  before  the  actual  filter 
Initialization  by  Implementing  tho  Mttun  technique  for  aduptlve  reHeallng,  a.*  tho  qimntltloa  BP  (J)  ,  J  =  1,  0 
are  reaoallng  faotora  for  change*  In  tho  cinvurlanoo  ma<  rlx  ilemon**  Xf I ,  J)  ,  Y(1,J)  and  for  the  quantities 
DX(I,J)  and  DY(I,J)  ,  where  DX(I,J)  and  l)Y(l.J)  are  tho  propagation  lnorcmonta  tu  oovarlanoo  matrix  elomenta 
Xd.il  Md  Yd. J)  .  rtgpootivaly.  Notai  Induing  la  uaed  in  programming  the  covariance  matrix  In  order  to 
mlnlmli*  computer  lnatructiona.  Thla  doog  mult  In  gome  proneiilhg  tiua  panelty, 


4.4,?  flveendng  Ifoiiuli 

The  Litton  adaptive  reaoallng  moduli  la  to  ba  teatad  at  the  beginning  of  aaoh  complete  paea  through  the 
filter.  Tho  phlloeophy  la  to  eoala  both  ahanneli  ldantloallyi  therafora,  the  maximum  valuei  of  the  ourrompimdlng 
dlagoHil  aliment*  (delimited  by  AMM(Jl)  of  tin  oovarianoi  matrix  suit  be  dmtarnlnmd.  mealing  oonitralntm  on 
tha  ilaminti  ere  get  go  that  all  itate  variable!  lie  batwetn  1/14  and  1/4  of  full  male  except  for  amlmuth.  which 
la  maalad  between  1/4  and  1/3,  alnoe  dlvlaion  by  ailmuth  la  nooexixry  In  the  oloied  form  cruai-ohannal  correlation*. 
With  theae  cunatralnta  meuhanland,  the  remainder  of  the  auatlng  loop  li  ueoeeeary  to  aoala  the  quantltlea  Indicated 
by  aliirtlng  either  left  or  right  one  bit, depending  on  the  ahiftlng  porxmntar.  rigure  7  li  a  flow  chart  of  tha 
riaaallni  program. 


1,  gIMIJLAT ION  RKRUl.TI  / 

Thla  aeutlun  oontalna  almulatlon  reaulti  for  a  teat  minion,  Tha  aaauaptioni  arm  that  thw  myitim  waa  ground* 
aligned  ualng  ounvantlunal  technique*  and  the  filter  waa  iaitlalliad  at  the  lnatant  tha  vahlola  bagan  moving, 

In  order  to  llluatrate  tha  potential  auuuraoy  improvement  by  Ualng  a  filter,  the  eyatea  and  filttr  ware  run 
“opon-loop",  l,e,,  the  filter  wee  run  ae  an  aetiaator,  not  a  controller,  euoh  that  normaliead  rather  then 
dependent  error*  could  be  oumpared, 

In  the  eyatem-pertormanoi  ourvea  (Plgurea  I  through  11)  the  net  raaliltlng  error  It  the  difference  between  the 
ut letted  and  actual  eyaten  errora,  The  ourvea  preiented  In  Figure*  I  through  II  are  baaed  on  a  profile  which 
contain*  tavaral  vaioulty  fludfcua.lunai  ttirtlng  and  atopplng;  during  the  profile;  4»°  latitude!  *nd  error 
aourate  elmllar  tu  an  IN- 18  type  platform  (tha  ayatam  errure  are  largtr  than  that  aipacted  from  an  actual  LN-15 
for  a  elmllar  appllnatluni  howavar,  for  th*  atmulated  mlaaion,  tha  full  knowledga  of  arror-aourca  oorralatlcua 
waa  nut  employed) , 
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CHAPTER  17  -  MARINI  APPLICATION!  OP  KALMAN  PILTKRINO 
J.Holdeworth  and  J,  Stoll 


1.  INTRODUCTION  AND  DESCRIPTIONS  OP  THE  PROIILEM 


»j] 


This  chapter  Is  concerned  with  the  application  of  Kaliian  flltsrlnt  techniques  to  estimating  ths  squat  Ions  of 
notion  of  aubaorged  objects  in  tho  oassn.  Applications  can  be  mads  to  monitor  the  movement  of  eubnerinee  as  well 
at  ths  movement  ot  schoole  of  largo  fish  or  eubmnrlno  mam/mils,  Another  interesting  application  la  ths  optimal 
oontrol  af  cabled  communication,  wiro-guidsd  submarine  devices.  Hers  the  estimation  of  tho  remote  control 
d«vice' s  track  would  be  useful  to  evaluate  if  a  device  has  sufficiently  searched  a  particular  topographical  area 
of  intereet.  Also  af  Interact  le  the  situation  where  a' single  command  and  oontrol  ship  monitors  and  aantrale  the 
operation  of  some  activity  in  ths  ocean  area  of  ite  immediate  vicinity.  The  Kalman  filter  can  be  used  to  traolt 
the  aotivlty  of  all  objects  in  a  predetermined  area.  Thus  the  Kalman  filter  can  be  used  to  guide  the  movement 
of  scuba  divers  in  undersea  eaplorstlon  or  in  the  harvesting  of  food  os  the  oceaa  floor. 

The  oceen  is  the  medium  in  which  the  Kalman  filter's  eetlaation  process  has  to  operate,  Communications  between 
two  abjeote  separated  by  several  thoumaad  yards  le  obtained  by  sound.  The  speed  of  sound  in  water  le  nominally 
4800  ft/sea  and  it  le  primarily  a  function  of  water  temperature,  pressure,  and  salinity  mad  ie  given  by  the 
empirical  formula 


where 


C  «  4433  +  11.  28t  -  0,04St'  +  0,0183d  +4,3  (*- 
0  s  velocity  af  sound  (ft/eec) 
d  »  water  depth  (ft) 
t  ■  temperature  cf  water  at  d  (°P) 
e  «  salinity  (parte  per  thousand). 
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The  propagation  path  of  sound  in  water  ie  quite  different  from  the  paths  of  electromagnetic  radiations  used 
by  radar  traaking  systems,  The  propagation  path  of  sound  is  quits  non-linear  and  its  general  nature  can  be 
described  by  ray  theory1.  The  different  modes  af  propagation  are  various  combination!  of  dirsot  path,  surface 
ahannel,  bottom  bounce  and  convergence  zone.  The  direct  path  mode  is  where  the  sound  path  that  oonneots  two 
objecta  is  not  reflected  by  any  acoustiaal  boundary,  Tbe  surface  channel  made  is  where  the  sound  path  connecting 
two  objects  is  refleoted  at  least  onae  by  the  physical  boundary  between  the  water  and  the  atmoephere,  The 
bottom  bounoe  mode  ie  where  the  sound  path  connecting  two  objeots  is  reflected  at  least  once  by  the  boundary 
between  the  water  and  the  ocean  floor.  Tbe  convergence  son*  mode  la  where  tbe  sound  path  connecting  two  objects 
is  refracted  due  to  the  sound  my  "vertexing".  This  occurs  when  the  ray  path  attains  a  horlauntal  tangenoy  at 
a  certain  ooean  depth1. 

Thus,  the  total  transit  time  of  sound  from  one  object  to  another  is  a  function  of  the  propagation  path  uid 
tbe  velocity  of  sound  in  the  water.  The  different  propagation  modes  are  illustrated  in  Figure  1, 

The  underwater  systems  that  either  communicate  by  sound  or  iwnitor  sound  souroes  are  oolled  sonars.  Tbe  sonar 
system  of  interest  to  us  is  the  echo-ranging  sonars,  which  operate  by  monitoring  sound  reflected  by  an  underwater 
object  that  was  originally  an  iuput  to  the  water  by  the  receiving  ship.'  The  measurements  taken  by  the  eoho-ranglng 
sonar  ore  range,  bearing  and  sometimes  range-rate.  The  range  Information  (R)  is  calculated  by 


iv. 


tlon  (!)  le  obtained  by  measuring  the  direction  of  the  reflecting  underwater  abject, 
is  obtained  from  the  relationship 


f  >  0.  gs  f,A  , 


(1.1) 

Ths  bearing  informa- 
Tho  range-rate  (A)  informatics 

(1.3) 


where  f(  is  the  frequency  of  the  transmitting  souroo  (ko/s),  f  (o/s)  Is  the  observed  change  in  frequency  when 
the  sound  signal  is  returned  and  0,63  is  a  Doppler  constant  for  eoho  transmission  (o/kt  kc).  The  measured  observa¬ 
tions  (B.R.A)  era  corrupted  by  several  typos  of  noise  souruss.  The  structure  of  the  noise  is  very  complex1  and 
will  not  be  dealt  with  here.  The  accuracies  to  which  the  observations  B  ,  R  ,  A  can  be  measured  are  a  function 
of  beam-width,  pulse-length,  frsquenoy  discrimination,  and  slgnal-to-nolee  ratio  seanurlng  characteristics  of  each 
sonar,  For  the  purposes  of  this  analysis,  the  additive  noise  on  bearing  information  can  be  thought  of  ae  a 
stationary  aero  mean,  gaussion  process  whero  the  standard  deviation  of  the  error  is  about  0. 5  degrees.  The  range 
information  can  also  b*  thought  of  es  a  gaussisn  process  whert  ths  vitrivtoe  changes  linearly  eith  relative  rangy 
(It)  (distance  between  one  object  and  another),  The  tins  difference  between  coneecutlve  eemplei  ie  long  enough 
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iuoh  that  autoacrrilatlon  of  bttrlng  and  rtngti  It  lnaignifUent,  Alio  thi  oroit  eorrtletlon  bitween  rtniti  and 
biaringi  It  tnugnlfloint.  The  tocurtoltt  of  tho  rante-rstt  information  tro  about  6  Knott. 


I  APPLICATION  OF  KALMAN  FILTERING  TO  VUG  MARINE 
TI'ACKINfl  PROBLEM 

I.  i  dtnartl 

Vt  thRll  now  brltfly  detorlbt  tht  bttio  tquationi  which  trt  rtquirtd  to  perform  thi  trtoklnt  proem.  Tht 
tricking  procott  It  batlcelly  i  Kalman  fllttr  optrttlng  on  tht  obttrvttloni  of  rtnge,  bearing,  end  Doppler. 

Tht  tbovt  obiorvationil  ttt  oorrttpondt  to  tht  ictlvt  tontr  modi  of  operation.  Tht  tquationi  for  tht  ptitlvt 
tontr  modi  ire  different  and  will  not  be  conaidertd  here.  The  obitmtiom  htvt  flrit  to  be  oorrectid  to  give 
true  bearing,  horlzontil  rtnge  mil  range  rato.  ThU  Involve!  pre-proettting  the  obatrvations  to  aooount  for  the 
tound  propagation  modo.  The  obtervntion  pre-proootelng  can  be  accounted  for  directly  In  the  Kalinin  filter  ltaolf, 
but  tble  would  grontly  complicate  tho  formulation,  Our  treatment  will  bB  brief  end  doecrlpi.lvo  Inetead  of 
detailed  and  rlgoroub.  Derivations  uf  the  equations  from  a  minimum  mean  square  prediction  error  oriturlon  are 
well  known1  and  ara  data! led  in  previoua  notion  of  thla  publication. 


I 


I, I  Kalian  Filter  Equation 


Hi  baaio  component  of  the  eitlmation  prooeat  li  t  atate  viator  whole  value  at  aoaa  tin  tk  la  given  by 


U  k) 


1  ’ 
X(k) 
*  * 


(3.  1) 


The  oongionenti  of  th*  target1  a  atate  veotor  are  the  eomponenti  of  the  relative  poaltion  with  reapeot  to  our 
traoklng  veeael  and  the  abeolute  component!  of  the  veluolty  of  the  target,  The  atate  equation  which  daaorlbua 
the  dynaalo  development  of  tha  target  atate  veotor  In  time  nay  be  written 

X(k)  -  <*<k)S<k-l)  ,  (3,3) 


•here,  for  our  oaaa,  tha  atata  tranaitlon  aatrlx  la  given  by 


The  quantity  Atk  la  tha  tlna  between  receipt  of  the  (k-l)th  and  the  k**'  pleoe  of  data  (report).  If  the 
data  rate  It  oonetant,  than  Atk  >  At  ia  oonatant  and  the  tranaitlon  aatrlx  <$(k)  diaorlbed  by  Equation  (3.3) 
doaa  not  depend  upon  time.  The  value  of  At  la  determined  u  priori  by  *  ring*  getting  that  la  well  beyond  the 
range  of  thi  tergwt.  Tha  eotual  proowealug  of  the  data  will  be  divided  Into  two  parte.  The  flrat  Involve!  range 
(Rk)  and  bearing  (8k)  only.  The  eeoond  involve!,  in  addition  to  range  (Rk)  and  hairing  (3k),  range-rate  (8)  aa 
wall.  The  data  viator  Zk  for  thw  flrat  eat  of  obaervationa  nay  bw  written  ae  followa; 


H '(k)SC(k)  +  «k  v 


(3.  4) 


In  Equation  (3.4),  M'(k)  la  allied  the  aeeturieent  aatrlx,  whloh  relate!  the  obttrvtd  data  rtotor  Zk  to  tha' 
twgtt  atatt  viotor  X(k)  .  In  our  otae  the  aeaeureeent  matrix  doee  not  depend  upon  tha  time  tk  and  may  be 
explicitly  written  cut  ae 


M'(k) 


1  0  0\ 

0  0  1/  ’ 


(3.5) 


The  twra  «£  denote*  the  2ul  note*  veotor  due  to  th*  noie*  perturbation!  on  the  aeeeured  btarlng  tngl*  §k 
end  rang*  Rk  .  Aaauaing  that  tha  ataaureaent  nolle  on  tht  range  end  bearing  It  unoorralatad  and  atro  mu,  It 
followa  that  tha  ooverlanow  matrix  of  our  nolle  vector  le  approximately  given  by 


•ln*SkO|  +  Rk  ooe’S^  |  itn!koo»Bk(o,{-(lJcrj) 


a  J  g  /  T]  jjl  ■l..aiiamMm-wiaai|M  eaaa  uaiamiiiiamaj  ^ 

*  *  i  \itn  lkoot  fljt  <ojl  —  RJo-*)  joo»  Bjo,  +  Rk  iln’iki^/ 


(3,0) 


The  target  atate  veotor  3t(k)  le  unknown  to  ut  and  mutt  be  aatimatid  froa  th*  obawrvid  data  vwntor  Zk  and 
whatever  knowledge  we  have  of  thu  meiauremint  nolle  added  to  the  obterved  rtugee  and  baarlnga.  Let  X(k-  l) 
denote  the  eatlmate  of  tha  target  state  vector  btatd  upon  whattvar  a  priori  knowltdgt  wt  htvt,  togtthtr  with  all 
tht  obaervtd  data  obtiinad  up  to  and  including  tint  tk.t  .  At  tlmt  tk  a  new  data  victor  Zk  It  obttrvtd, 


V.- 


In  tha  Kalman  filter  model  the  tie*  updated  estimate  of  the  target  etete  vector  in  recursively  determined 
toeordlni  to  the  following  equation: 

8(k)  b  MoXtk-  1)  *  K(k)[zJ  -  MV>(k)X(k-t)]  .  (3, 7) 

A 

In  Equation  (3.1),  the  tern  <M)Ji(k-l)  le  the  updated  predict  ion  of  tht  target  etete  from  tho  dynamto 
Equation  (3.3),  bated  Juat  on  thu  data  available  at  stage  k  -  1  and  before.  Likewise  the  term 

«V(k)i(k-l)  (!,*) 

bated  on  the  (k-  l) th 

Zi  -  MV><k)il(k-l) 


la  nur  prediction  of  the  neteureuent  veotor  Zk 


attge  data,  to  that 


(2, 0) 

la  the  obeerved  dlicrepanoy  between  tho  netaurtd  data  veotor  at  itage  k  and  the  predicted  data  vector  batnd 
upon  prior  Information, 


K(k)  In  Equation  (2.7)  la  the  Kalman  tain  matrix  which  weights  the  observed  measurement  discrepancy.  It 
la  ohoaan  to  minimise  the  mean  square  error  in  the  UHt ImutoH  of  the  components  or  tho  target  nlato  vector.  If 
an  let  P(k)  denote  the  covariance  matrix  of  the  eatlmate  of  the  target  state  vector  at  time  tk  ,  l.e. , 

P(k)  «  n[(i(k>  -X(k»(X(k)  -  «(k)>T)  .  (2.  io)( 

whtre  e[  ]  denotea  the  eapeatad  value  operation,  then  it  nay  be  shown 1  that  the  Kalman  gain  matrix  may  be 
written  ai 

(J,  11) 


K(k)  «  tf>(k)P(k- D^kjM^CM'^MPfk- i)^T(k)M'T  +  *l)‘ 


leginning  with  so  Initial  oovarlanoa  matrix  P<0)  of  an  eatimatad  atata  vootor,  it  aay  ba  ahown  that  the 
dtvalopmant  the  targat  atata  oovarlanoa  matrix  >  a  function  of  t*«i»  la  obtained  from  the  following  rwouralvt 
aquation) 

P(k)  =  0(k)P(k-l) /(kj  -  K(k)tt'0(k)P(k- l)i/>T(k)  ,  (3,12) 

Whau  Doppler  data  la  available  tht  prooadura,  wh  .i  combined  with  tha  foregoing  prooaaa,  la  aa  follow*,  Tht 
computational  aquation*  ala  quite  similar  fur  tha  seaond  set  of  obsirvttions.  The  state  transition  matrix  4>(k) 
beooaea 


(».  13) 


and  tha  data  vaotor  nay  ba  written  aa 

/ fL  ala  Rg  t  Rk  cos  8.8 

tj[  •  ( 

\Rk  oos  Rk  -  Rk  tin  RkRk 
In  Equation  (3.14),  M"(k)  la  glvtn  by 

l"(k) 

and,  similar  to  Equation  (3.4),  the  term  *" 


M " (It)  X(k)  +  *{l 


(3. 14) 


/I  0  0  0\ 
\0  0  1  0/ 


9 

,0  0 

in  Equation  (2. 14)  la  a  3  a  1  noiae  vaotor  due  to  the  noiee 


(3.  13) 


perturbations  on  tha  measured  bearing  angle*  Sk  ,  range  ftk  ,  range-rate  Rk  and  the  iupport  observation  8k  . 
Ilnoa  lk  la  not  an  axplloit  olwervatluu,  it  can  ba  aynthealaad  by  aithar  of  two  methods,  Tha  tare  R,t  can  ba 
owloulatad  hy  ... 

Bk  *  <Rk-Rk.,)/)it  (2,18) 

or  by 


*k 


’  T(k)^  -  X(k)fr 


Y(k) 


+  X^k) 


(2. 17) 


Tha  ooaponanta  Y(k)  and  X(IO  In  Equation  (2, 17)  ara  obtained 
are  obtained  by 

kg  ■  k  —  Rq 
*r  -  *-*». 

where  Xa  la  tba  motion  of  tha  observation  vatnal  in  the  X-dlrectlon  and  f0  la  tha  motion  of  the  observation 
vassal  In  .tha  Y-dlraotion,  Also,  the  range-rate  information  in  the  data  vaotor  glvtn  by  Equation  (3.14)  Is 
relative  range-rite,  whioh  was  obtained  by 

Rk  -  JT  -  h0  ,  (3, 10) 

Tha  term  iT  la  tb*  actual  observation  obtained  from  the  aoaar.  Thu  term  ft0  le  obtained  from  the  observa¬ 
tional  waiter  a  union.  The  covarlauoe  matrix  of  the  noiae  vector  given  by  Equation  (3.  14)  may  be  written  us 


htl 


i 
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£{  glnfik  4  cj  no*'ik  4  KJ  ooa'B^Jj  4  !  ooi  Sk  «inBk[o{-llJtf{-  ■M* 

4  (Rk  co»lk-  Rk  a  In  fi|8k),crj  I  4  erjtfigftj  “Rk)l  4  o'RkIEk  (ain'l 

\  oo»lk  alnfik(trJ-ll{crJ-IIJof  4  |cr[  oo«‘ik  4  er*  ■ln,BkS{[  4  K||  *tn'§koi  4 

I 


ta.  aii) 


V 


°l(Rkik  -  R()]  4  crj»kl!k  (»ln'ik  -  ao»*&k)  j  4  (Rk  *inlk4  ftk  co*fikfik)'o|  / 

Tha  mm  prooaae  la  repeated  far  Equation*  (3.7),  (3.11)  and  (3.13),  replacing  Zk  ,  M'  ,  and  Wk  by  2k  , 


II"  and  Mk  . 


Thu  beginning  0!  the  Kalman  filtering  proaaaa  la  (Ivan  by 


P<0) 


(3.31) 


vhara  tha  quantity  9000  ia  aomowhat  arbitrary,  tha  1 up octant  thing  balm  that  tha  dlagunal  alananta  nt  P(0) 
ba  larga  go  that  tha  flKar  will  forget  tha  Initial  valuta  aa  ear#  data  arriva,  and 


X(0) 


(2,33) 


Tha  pruoe**  can  ba  oarrlad  out  ltaratlvaly  f or  Mdh  nt»  aat  0 f  obatrvational  reporta, 

0.  ,  ak  in  Equatlona  (2.6)  and  (3,30)  ara  dataralnad  a  priori  and  oan  ba  raadjuatad 


Tha  vgrlablat  a,,  o.  ,  srk  in  aquaciona  (g.c)  ana  w.  w)  art  naierninan  a 
adgptivaly  if  daairad.  Tha  varlabla  trk  In  Equation  (3.30)  ia  oalouiatad  by 


crj  a  /SCj/A T  , 


(3.33) 


3.  THE  NANCUVEltNO  TARfllT  PROBLKN 
1. 1  flanaral 


In  the  typloal  tracking  problan  tba  targat  (aubmarine  objaot  of  intaraat)  *111  not,  In  ganarnl,  maintain  a 
policy  of  a  con* taut  count  and  npttd.  If  tha  targat  ia  a  aubmarina,  it.  *111  utually  parforn  a  taqutnoa  or 
abort  etralgbt-Une  aantuvtra.  If  tha  target  la  a  oablad  coanunloatlon,  alra-guldad  aubmarine  davlot,  tha 
movaaanta  ara  oonatralnad  by  tha  topography  of  tha  ooaan  floor.  Ulnae  thi  elation  utually  raqulraa  that  tba 
target  oparataa  in  alone  praaimlty  to  ooaan  floor  the  motion  oould  be  highly  nonlinear.  In  thla  ante,  the 
ulamtloal  eatlaatlou  of  the  targat' a  iiotlun  will  ba  corrupted  by  tha  nonlinear  aovaaant  of  the  target.  Thua 
the  problem  lndlcatea  a  need  to  model  directly  tha  unoartalntlta  of  the  target'  e  motion  in  the  eatimation  proace*. 
The  Kalman  filter  oan  be  adapted  to  reflect  explicitly  tba  uncertainty  of  the  target' a  atata  eatlmatee  at  any 
time  due  to  tha  random  nonlinearity  of  the  target.  Thi*  ban  led  to  the  development  of  an  uncertainty  gain 
matrix  U.  . 


1.1  Tbm  Derivation  of  the  Uncertainty  Cain  matrix  (Ua) 

Tha  atata  vector  of  a  targat  with  random  maneuvering  capability  lx  given  by 

X  •  1,41,. 

where  3  ,  3(  ,  Kk  are  4x1  oolumn  vactora. 

In  Equation  (3. 1),  2,  ia  (Ivan  by 


(1. 1) 


S. 


(3.3) 


and  K,  in  given  by 


*.  =  a* 


In  Equation  (3.3)  the  oomponunta  rcproaent  thu  trim  mot Lun  of  the  target  (of  tho  non-menauvorliig  ease  and  tho 
espaatsd  notion  for  the  random  maneuvering  case,  tn  equation  (3.3)  the  components  repreeent  the  devlatlone  about 
the  expected  state  vector  fur  the  maneuvering  oaae.  Thun  the  error  covariance  matrix  P  la  tlven  by 

KCfiJ  - X) (< - X)  t>.  «  E((X  - XB)  (SX.)T)  a  K(B,(lJ)  (3.4) 

t  t‘  ♦  u0  •  (3.S) 

tn  the  non-aanauvsrlng  oaae,  the  uiiuartaluty  gain  matrix  (Ua)  la  aaro  In  equation  (3.3)  and  Pap', 


The  components  are  derived  as  follow*: 


*  »  l.ainc  (1, fl 

«j  «  «,  alnQ  +  «0  8  euiO  (3.7 

i  >  gooaC  (3,  g 

*1  ■  ‘i,  001  0-  I,  a  alh  G  (3.  t 

■  *,  “  «»At  (3,10 

«,  -  «*At  (3.11 

there  a  a  target  apead,  0  a  target  oourae  and  At  a  tinea  between  eonaaoutlva  data  report!, 

All  the  coaponanta  of  K,  are  aeauaad  to  be  unaoi’ralatad,  an  wall  a*  the  a  quantities,  Thu*  U„  In  a 
diagonal  matrix  obtained  by  oilculatiiig'thi  varlanou*  of ‘tquatloni  (8,1),  (l.B),  (3.10)  and  (3,11), 


The  component*  of  Equation  (3.  11)  are 

<r}  ■  crj  gln'o  +  0*  A*  ooa'C  (3,  13) 

<rj  ■  At'  crj 

0}  ■  <rj  ooa'c  +  crj  »*  eln'C  (3.  M) 

£rj  ■  At*  crj, 

In  EquatlOJll  (3. 11),  (3, 14),  ir,  '  la  the  apaad  ohanga  capability  in  tb«  tlaa  interval  At  and  tr0  la  the  course 
ebanga  capability  In  the  tine  Interval  At  ,  The  varlablta  v$'  and  are  obtained  by 

’  fa  ■  iAt  (3,13) 

»8  ■  d'A*.  (9.  It) 

wbara  I  in  Equation  (3.19)  and  i  In  Equation  (3.13)  art  Input  quantities  that  diioribg  ths  target's  speed 
end  course  change  capability, 

4.  ADAPTIVE  DETERMINATION  OP  MEASUREMENT  NOIRE 
CHARACTERISTICS 

Thu*  far  In  our  treatment  w*  have  esaumtd  that  aa  poiaaaaad  total  itatlatloal  knowledge  of  the  noise  which 
la  asiuasd  to  addltlvaly  corrupt  our  ring*  and  blaring  nuaguramants.  As  oan  be  seen  from  savors!  of  the  foregoing 
aquations,  for  example  Equation  (S  O),  the  valuea  of  ths  bearing  and  range  urror  nteaursnvnh  nulls  variances 
are  necessary  to  calculate  the  gain  matrix.  A  perfent  knowledge  of  the  defining  pgramatarx  of  tha  noise 
atatiatlca  would  permit  ua  to  utilise  theaa  quantltlea  in  tha  most  efficient  manner  In  the  design  of  tha  filter 
and  to  construct  a  theoretically  optimal  filter. 
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Unfortunately  one  raruly  has  complete  knuwloclge  nf  tho  statistical  structure  of  the  meanui-emenb  iwHu.  Moro- 
uvor,  In  mitrlns  application*  tlm  actual  nulse  is  likely  tu  uossoea  n  very  oumii  1  icnteil  structure  so  t hut  the 
assignment  of  fixed  numerical  values  to  aunli  tilin'"  1 ! 1  "s  as  imiUHiiruiiiunt  variances  in  likely  tn  bo  prosuniptuouii 
it  bast,  thin  practice  of  cs.tumlng  vsIuoh  for  m«u»urciiianl  mi  Iso  variances  anil  building  them  into  tlm  filter 
could  result  In  the  construction  of  the  host  filter  fur  the  wrong  iirubtem, 

Intuitively,  what  ono  would  like  Is  to  design  a  filter  which  hnd  a  Minimal  dopninlnnco  upon  numerical  values 
of  narsmeters  which  were  known  with  Imperfect  confidence.  Borne  knowledge  of  meseurnment  noise  variances  Is 
nsuimnnry,  however,  lh  order  to  allow  the  filler  tu  apply  the  appropriate  weighting  to  tho  Input  data.  This 
tuggasts  tho  possibility  of  designing  the  filter  su  that  It  nan  estimate,  or  at  least  monitor,  the  value  of  the 
measurement  noise  variances  to  ensure  that  the  proper  weighting  was  being  given  tu  tlm  data,  if  title  could 
bs  done,  it  would  release  the  filter  designer  from  the  neesselty  of  supplying  numerical  values  fur  measurement 
noise  variances  whore  the  validity  of  those  values  was  quite  uncertain. 


One  manner  In  which  this  adaptive  vur lance  estimation  might  he  performed  la  as  fuUuws.  Let  us  dniiotu 


X*(k)  =  e-(k)8(k  -  1) 


14.  1) 


Then  baaed  upon  our  (k-  l)kh  stags  sstlmsts,  we  may  priiUat  tin  vslu*  of  tho  bearing  to  be  obaervtd  at  time  tk 
by  writing 


.a.* 


.*t  *Lii> 

Y*<k) 


At  itage  n  ,  the  bearing  error  variance  may  ho  adaptively  estimated  from  the  equation 

*  i  ft tf'*  ' 


(4.3) 


(4.8) 


whire  ’{  is  the  aotusl  muaeurtd  value  uf  the  liearlhg  at  time  t(  .  For  rmili  time  praotialng  Equatiun  (4.3) 
say  bs  written  in  the  following  very  eimple  recursive  furmt 


n 


(4.4) 


Blmllerly,  If  we  deflns  our  predicted  rsne«  H*  to  be  given  by 

8*  ■  i'('X*(l)'  ♦  T*(t)  *)  ,  (4.8) 

then  equations  analogous  to  Equations  (4.11)  and  (4.4)  may  be  written  tu  edeptlvely  eetiiate  the  variance  on  the 
range  measurement  errors. 

One  of  tin  noise  anurous  might  coimwlvuhly  be  oon-statlonsry.  In  particular.  In  many  situations  It  sssmi 
that  tin  range  msauioemsiit  error  vurlauos  la  Itself  dependent  upon  range.  In  this  avsnt  we  ouuld  so count  for 
the  non-etatloimrUy  In  the  iiuUu  veriaiun  by  limiting  tlm  "memory”  uf  our  adaptive  range  variance  estimator 
tu  tin  must  recent  m  pieuee  of  tluU.  (n  tills  usse  the  "smoothed1'  estimated  range  vwrlanos  at  time  l|(  would 
be  given  by 


n/e 


into  !R*'iik>'  ' 


(4.  6) 


The  trick  in  ua^eg  Equation  (4  1)  la  to  ohuoau  m  to  be  miff toleiitly  Urge  au  that  ssmuling  fluctuetlune  are 
■Mouthed  out  in  the  numputatlpn,  hut  sufficiently  email  su  that  llw  actual  variation  of  tin  true  variance  with 
the  range  la  reflected.  Equation  (4.0)  uun  tiw  easily  manlpulrted  and  written  In  the  following  rtoureive  form 
for  real  Ilea  computation, 

.1 


Vn 


(a- !)/■ 


i  k  •  v'  -  (Ci-m-viv' 


(4,7) 


We  have  epplletl  tin  adaptive  technique*  Juki  described  to  the  case  uf  a  linearly  movlne  and  a  maneuvering  target, 
The  reuniting  root  menu  aquarii  speed  errors,  based  upon  ID  Monte  Carlu  ruin  are  shown  in  Figure  g.  nils  shows 
tint  the  results  of  the  adaptive  variance  eatiiiatluii  gave  ooinlileniblu  Improvement  over  tin  nun-mluptlve  estimates, 
where,  for  tlm  uuii-wduptlvu  ousu.  the  Input  muuKuriihvnt  stnnduril  deviations  were  In  error  by  a  fautor  uf  3. 

Error*  In  kuowlodgti  of  input  measurement  vuriaiiuvs  uun  often  be  tills  Urge  so  that  we  f'ml  that  this  figure 
riipreauuts  a  realistic  situation  nud  that  urforU  to  extend  such  adaptive  teuluilquus  should  be  pursued. 


Th«  potentiality  fur  an  adaptive  moatturnmunt  noise  variance  estimation  capnblllty  tu  bn  l no  1  iirted  within  the 
filter  la  especially  promising  for  trackinu  situations  where  the  tracking  extends  over  an  appreciable  perlud  of 
time,  For  very  short  torn  tracking  engagements  tho  time*  Involved  are  likely  to  be  too  short  for  the  adaptive 
variance  eatlmatea  to  etablllze.  Thus,  for  short  tracking  encounters,  one  "'ill  pruhnhly  have  to  bo  content  with 
utilization  of  whatever  o  priori  knowledge  ha  has  af  the  measurement  noise  variances  in  the  data  weighting. 
However,  for  long  time  period  tracking,  this  technique  looks  very  promising. 


5,  EXAMPLES 

Me  will  consider  four  typical  steering  patterns  for  submarines:  constant  course  und  speed  (Pig. 3).  fast  90° 
turn  (Fig, 4),  slow  SO0  turn  (Fig  5),  and  a  sequence  of  maneuvers  that  will  maintain  an  average  speed  Ip  a 
preferred  direction  (Fig. 6).  The  constant  course  and  spoed  geometry  will  test  how  well  the  Kalman  filter  can 
track  a  cooperative  submarine.  For  this  case  tho  Kalmun  filter  will  have  a  zero  uncertainty  gain  function  and 
this  will  demonstrate  its  heavy  smoothing  capability.  The  fast  90°  turn  maneuver  will  test  two  important  factors. 
The  first  factor  la  tho  manouver  recognition  time  and  tho  second  is  the  tracker  recovery  time.  Tho  maneuver 
recognition  time  Is  tho  time  from  the  beginning  of  a  sharp  maneuver  to  the  time  tho  Kalman  filter  Is  definitely 
correcting  tu  the  now  heading.  Tho  tracker  recovery  time  Is  the  tiro  from  the  termination  of  the  sharp  miuinuver 
to  tho  time  that  the  Kalmun  filter  is  estimating  tho  new  courso  end  speed  within  some  predetermined  error  bounds. 
The  slow  00°  turn  manouver  will  test  the  Kalman  filter's  steady-state  riaponsB  to  a  constant  rato  courso  change 
The  sequence  of  font  90°  maneuvers  will  test  tho  Kalman  filter's  ability  to  track  a  rapidly  maneuvering  submarine. 
The  Knlman  filter  will  nover  be  able  to  estimate,  to  a  high  degree  of  accuracy,  the  target  course  and  speed, 
but  it  will  bo  able  to  given  an  Indication  of  the  agility  of  the  tracker  for  different  uncertainty  gain  functions. 
In  this  oaoe  the  posit. on  errors  and  velocity  errors  become  the  important  evaluation  factors.  For  the  experi¬ 
ments  we  will  consider  a  North-East  coordinate  system,  where  North  is  the  Y-axis  and  East  Is  the  X-axis.  Wo  will 
also  have  the  tracking  platform  (our  ship)  standing  still  at  X  =  0  and  1  =  0, 

Gtomitry  I.  Comtant  Count  and  Spud 

The  geometry  la  illustrated  In  Figure  3.  Initially  the  target  starts  at  X  =  2000  yards  and  Y  =  10,000  yards. 

The  target  will  maintain  a  constant  speed  of  2B  knots  on  a  course  of  135  degrees. 

Ct atu try  II.  Fait  30-Digrie  Turn 

The  geometry  Is  illustrated  in  Figura  4.  Initially  the  target  etarte  at  X  s  2000  yards  and  Y  =  10,000 

yards  en  a  eouraa  of  ISO  degreat  maintaining  a  spaed  of  25  knots.  After  204  aeoonds  the  submarine  performs  a 

45-aecond  maneuvar  to  a  new  course  of  90  degrees  and  a  speed  of  15  knots,  At  the  time  of  the  maneuver  the 
target  was  approximately  7000  yards  from  our  own  ship, 

Gtamitry  III.  Slow  90-D*$rri  Turn 

Tht  geometry  la  Illustrated  In  Figure  5.  Initially  the  target  starts  at  X  =  2000  yards  end  Y  =  10, COO  yards, 
on  a  count  of  180  degrees  oalntalnlng  a  apesd  of  25  knots.  After  io  second!  the  submarine  performs  a  450-aooond 
manauvtr  to  a  naw  oouraa  of  SO  degrees  at  the  same  spaed  of  25  knots. 

Geometry  IV.  Stqumci  of  Fait  90-Dtgrt*  Tumi 

Tht  geometry  Is  Illustrated  In  Figure  6.  Initially  the  target  start*  at  X  =  3000  yards  and  Y  -  10, 000  yards 
on  a  course  of  180  degrees  maintaining  a  speed  of  25  knots.  The  submarine  will  perform  a  sequence  of  90-degree 
turns  so  that  it  (ill  atill  have  a  preferred  direction  of  180  degreos.  The  speed  In  the  preferred  direction  *»« 
to  be  90%  of  the  actual  speed  of  the  submarine.  The  time  duration  of  csoh  maneuver  was  80  seconds,  so  that  the 
final  range  will  be  approximately  4000  yards. 


«.  ANALYSIS  OF  RESULTS 

The  purpose  of  this  section  Is  to  present  a  description  of  the  graphical  results.  All  the  computer  runs  were 
made  with  10  different  Monte  Carlo  runs  to  obtain  ths  root  mean  square  (r.s.s.)  error  statistics  associated  with 
each  gsosetry.  The  results  presented  are  for  r.m.e.  course,  speed,  velocity  and  position  errors.  The  error  In 
course  la  found  by  calculating  ths  r.m.s.  difference  between  the  estimated  and  true  course.  The  error  In  speed 
U  fouad  by  taking  the  r.m.s.  difference  between  the  true  and  estimated  speed.  The  velocity  enor  Is  the  r.m.s. 
magnitude  of  the  velocity  error  vector,  The  position  error  is  the  r.m.s.  magnitude  of  the  poiition  error  vectors. 

The  result  of  ths  adaptivs  estimation  process  Is  pressnted  by  Flgurs  4.  In  ths  wsighting  of  the  observational 
d.ta  It  was  assuned  (guessed)  that  the  noise  sigma  on  the  range  infoimatlon  was  one  percent  of  range  and  one 
degree  ">n  the  besring  observations.  Actually  the  noise  algma  was  three  percent  of  range  and  three  degrees  on 
tha  bwai'.ng  observation,  Two  offsets  are  immediately  apparent.  First  the  adaptive  noise  estimation  process  Is 
worthwhile  In  that  It  has  smaller  associated  error  statistics.  Second  it  gives  a  significantly  more  stable 
estimate  of  the  target's  stits  vector,  Both  techniques  usod  the  same  bad  guess  sigmas  values  Tor  the  first  nine 
data  reports.  From  the  tenth  rsport  nn,  the  adaptive  Kalman  filter  used  Its  own  estimate  of  the  noise  sigmas, 
while  th«  other  continued  on  with  the  bod  guess. 
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Th«  remit*  of  th«  constant  sour**  and  sposd  target  ar*  presented  tn  Figure  3. 

This  geometry  was  run  with  the  Kalman  filter  processing  range  and  bearing  information  (KF)  and  with  the  Kalman 
filter  with  Doppler  processing  range,  bearing  and  range-rate  information  (KFWD) ,  The  only  significant  difference 
is  the  smaller  initial  orrors  of  tha  KFWD  tracking  system, 

The  results  of  the  fast  PO-degrae  turn  target  are  presented  in  Figure  4.  Aa  in  the  previous  ease,  both 
tracking  systems  (KF,  KFTO)  were  employed.  Due  to  the  rapid  closing  rate  of  the  target,  the  Initial  convergence 
of  tho  KF«tt>  tracker  le  very  significant.  Also  the  uee  of  Dopplor  information  greatly  aided  the  reaponee  of  the 
Kalman  filter  during  the  manouvor  that  occurred  at  204  seconds  into  tht  run.  The  time  difference  between  the 
two  trackers  to  return  to  the  nsw  track  la  significant. 

The  reoults  of  the  alow  90-degrees  turn  targot  are  present  3d  in  Figure  9.  The  geometry  Indicates  thn 
dlfferenoo  between  the  steady-state  response  of  the  KF  and  KFWD  trackers.  The  steady-state  response  to  the 
conetant  turn  rate  (0.2  dogrees/second)  of  the  KF  tracker  waa  2.9  knots  speed  error.  9.0  degrees  course  error 
end  80  ysrds  position  error.  The  steedy-state  response  of  the  KFWD  tracker  waa  1,7  knots  speed  error,  4.9 
degrees  course  error  and  70  yards  position  error. 

The  results  of  the  soqnence  of  the  fast  90-degree  maneuvering  target  are  presented  in  Figure  S.  Thla  geometry 
lndioatts  the  Kalman  filter's  reaper, si  to  a  sequence  of  conaeoutive  90-degree  turns  of  the  target.  It  la  apparent, 
that  the  KFWD  traoker  benefits  from  the  Doppler  Information,  The  speed  error  of  tht  KFWD  tracker,  throughout 
th*  entire  tsquanoe  of  sianeuvtr,  is  one-half  the  KF  tracker' *  speed  errors. 
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NOTATION 


Viators:  Lower  um*  letters  (Latin  or  Oreek,  with  arrowi) 

ilatricaa:  Capital  lattara  (Latin  or  Graak,  underlined) 

Functions  and  Constants:  Capital  or  lowar  oaaa  lattara  (Latin  or  Qraek) 
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J(t) 
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1(a) 

0(t) 

T. 


thruat  acceleration  vaotor 
total  aooaleratlon  vector 
poaltlon  vector 
velocity  vaotor 

rata  vaotor  of  navljational  coordlnata  systsn  with  respect  to  inertial  apace 
earth  rata  vector  with  raapeot  to  Inertial  apace 

3  -  3g  ,  rata  vebtor  of  the  navigational  coordinate  frane  with  raapeot  to  an 
earth-flaad  frane 

vector  of  au>  attraction 

\  -3t  x  (3gx?)  ,  gravity  vector 

value  of  the  iravity  vector  at  the  surface  of  the  earth 

length  of  the  radius  of  the  spherical  earth 

ecoeleroaeter  bias  vector 

gyro  drift  vaotor 

error  angja  vector  between  naviiationat  and  platform  coordinate  fraas 
error  anile  vaotor  between  conputer  and  plattorn  ooordlnata  frane 
position  error  vector  of  the  inertial  systen 

jA* 

Ar  ,  velocity  error  vaotor  of  the  inertial  systes 

referenoa  valooity  arror  vaotor 

velocity  vaotor  computed  in  th"  inertial  aystes 

referenoa  valooity  vector 

oontrol  siinals  in  updating  aschanlaations 

lain  conatanta 

•ohuler  freauenoy 

Bchuler  period 

tlee  variables 

Laplace  operator 

input  eimal  of  a  linear  ayatae 

output  signal  of  a  linear  aystes 

variance 

iapulee  response  of  e  linaer  eyetw 
transfer  funotlon  of  s  linear  systss 
oorrslatlon  tlas  of  ths  input  slgntl 


Dime  S-dlatrlbutlon 


U(t),  u, 
nfft  , 
hj,  h| 

573,5; 

573,5; 


Tit  pit 

*«  •  XK 


N(t)  ,  Nj 


tutQcon'tUtion  function 
power  spectral  donaity 
v’(-l)  ,  lmsiinarj’  unit  vector 
dlrtotton  cosine  matrix 
statu  vector 

controllable  pert  of  the  stats  vector 
uncontrollable  part  of  the  state  vector 
■oasurmiijnt  vector 
•tate  coefficient  matrix 
measurement  matrix 
system  white  noisa'veotora 

white  noise  driving  functions  of  the  controllable  and  uncontrollable  states 
measurement  white  noiee  veotor 
control  veotor 

0  pottiriori  estimate  of  the  etmte  veotor 

a  . 

the  controllable  end  unaontrollable  states  of  tp 
a  pripri  ustimate  of  the  state  vector 
oontrollahle  and  unaontrollable  states  of  xj 
a  priori  estimate  of  the  meaeursment 
•eiahtlni  matrix  (main  matrix) 
eovariance  matrix  of  the  a  priori  amtimation  error 
ouvarianoe  matrix  of  the  a  pottiriori  axtimatlon  error 
state  traniition  matrix 

appropriate  parte  of 
identity  matrix 

oovarlino*  matrix  of  tha  system  white  noise  veotor  hK 
eovariance  metrix  of  the  measurement  white  noiee  veotor  % 
dletribution  matrix  of  the  oontrol  veotor  £{ 
appropriate  pert  of  rt<il/K  for  the  oontrolleble  etetee 
a  unity  varlenoa  white  noise  source 
oorreletion  time 

output  funetion  of  a  shaping  filter 
rendoa  walk  parameter 
frequency  in  rad/e«o 
expectation  operator 

covariance  matrix  of  tho  white  noiee  veotor  n(t) 

Kronecker  symbol 
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CHAPTER  IN  -  OPTIMAL  USE  OP  REDUNDANT  INFORM  ATI  ON 
IN  AN  INERTIAL  NAVIGATION  SVSTEM 


P.O.Unitr  and  N.Ott 


1.  INTRODUCTION 

Accurate  and  reliable  navigation  is  t  very  Btnngont  requirement,  e sped  1  n  1 1  y  fur  military  mlaalone.  Penlred 
output*  from  *  navigation  ayntem  are  position,  velocity  nnrl  orientation  of  the  sensors  and  tho  vehicle  with 
respect  to  a  navigational  coordinate  system,  A  pure  inertial  navigation  systum  can  provide  all  this  information, 
but  thi  irrora  of  tn  inertial  gystan  ara  not  hounded,  i.a.  they  increase  with  time,  Therefore,  with  large 
■laslon  t littei,  the  errors  can  beaome  Intolerably  large.  Other  method!  of  navigation,  like  Doppler  dead  reckon¬ 
ing,  radio,  atsilar  etc,,  can  provide  only  part  of  the  information  required,  but  with  bounded  errors  in  velocity 
or  position,  A  navigation  system  that  fulfils  a  wldt  variaty  of  requlraieenti  for  reletlvaly  long  mlaalon  tlmei 
will  therefora  be  a  combination  of  an  martial  ayatea  with  other  nivlietlonel  aide,  8uoh  a  ayatem  can  provldo 
•11  thi  information  raouired  and,  at  tha  euae  time,  control  the  eyetem  irrora.  Dut  In  ordar  to  una  all  tho 
available  inforaatlon  in  the  heat  poialble  way  the  atatiatiea  of  tha  arror  eouroea  suit  be  known,  In  addition 
a  heavy  load  la  placid  on  tha  digital  oomputar,. 

Thla  oheptar  praaenta  the  different  method!  (l.e.  conventional  varaua  modern,  or  determlnletlo  vereua 
atatiatioel)  of  aiding  a  pure  lnerttel  eyatem  with  additional  or  radundant  navigation  information.  Dut,  boforo 
tha  basic  problem  of  updating  la  treated,  tha  availabla  aansor  outputs  are  oatagoriatd  and  n  general  block 
diagram  for  aided  inertial  navigation  ayataaa  is  derived.  The  pure  inertial  eyitem  in  e  Achuler-tuned  mode  la 
Included  in  this  block  dlegrem  as  e  epealnl  anse. 


I,  IkDCK  DIAOSiWH  or  AIDED  ‘INERTIAL  NAVIGATION  IIITtkl 

The  eentrel  unit  of  e  nevlgetlon  eystee  ie  the  nevigatlon  ooeputer.  its  inputs  ere  svtllable  dete  from 
eeneore,  such  ee  inertlel  eaueleretlon,  ground  npeed,  sir  speed,  heeding,  position  Information,  atallar  anglan, 
eto,  These  data  nay  ba  eontinuaua  in  analogue  or  digital  form,  or  lntarmittsnt  Uka  ground  fix  nointa.  The 
computer  has  to  calculate  tha  desired  navigation  outputs!  position,  velocity  end  orientation  of  the  eeneore 
and  the  vehlole  with  respect  to  a  navigational  coordlnats  intern,  in  addition  tha  oomputar  must  alio  compensate 
.for  senior  blaaei'ind  oaloulata  torquing  ooanandi  for  platform  gyros  or  poaltlonal  aarvoa  for  atallar  or  radar 
aqulpMot. 

figure  1  shoes  the  poialble  lnpute  and  required  outputs  of  e  navigation  syetea. 

Tha  available  senior  information,  ea  well  aa  the  ooaputed  output  dete,  can  ha  olaaalfitd  into  thraa  levala! 

Level  1;  Acceleration 

Laval  3i  Valoclty 

Laval  3!  Position  and  orientation. 

Orlantation  belongs  to  tha  use  level  is  pogitlon,  beoauee  angular  meaauramenta  lead  to  poaltion  information 
and  both  data  ooaplaiant  each  other,  Furthermore,  in  a  rotating  coordinate  films  orientation  angles  can  be 
derived  by  Integration  of  tha  angular  rate  vector  3  ,  Just  as  poaltion  is  derived  by  Integration  of  tho 
veloolty  veotor  V  . 

Figure  1  shows  tha  thraa  livele  and  tha  equivalent  inputs. 

Information  for  a  higher  level  oan  be  derived  from  a  lower  level  by  integration;  but  It  la  generally  not 
possible  to  derive  lower  level  Infomation  from  higher  leveli  by  differentiation. 

Tha  inforuatlnn  in  each  level  is  a  vector  in  the  navigation  coordinate  frame,  except  for  orientation,  where 
tha  information  la  in  tha  form  of  three  angles  or  the  direction  cosine  aatrlx  (M)  for  poa.ilble  coordinate 
transformation!, 

ir  the  navigation  true  is  rotating  with  reepwat  to  inertial  epaoe,  corrtotlone  for  scoelaration  suit  be 
Included,  it  la  can  be  rioogniaed  by  writing  the  beau  aquations 
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=  v  +  3  «  r  (3.3) 

dV\  j.  _  _  _  _  _ 

—  +  to  x  r  +  2u  x  v  +  w  x  &  x  r)  ,  (3. 3) 

dt/N 

where 

r  i  position  vector 

(dr.'dt),  =  tint  derivative  of  r  with  reapeot  to  Inertial  apace 

(d?/dt)N  a  v  *  derivative  of  ?  with  reaped  to  the  navigation  coordinate  frame 

3  -  rate  of  ohango  of  navigational  ooordlnnte  system  with  respect  to  Inertial  apace 

a  -  threat  aooeleratlon  vector 

g„  =  vector  of  msuti  attraction 

h  o  (dv7dt)N  -  total  aooeloratlon  In  navigation  coordinate*. 

Substitution  of  Equation  (3,3)  Into  Equation  (3.1)  yields 

b  =  a  +  Vs  -  i  *  r  -  32  *  v  -  3  »  (3  xr)  ,  (3.4) 

Equation  (3.4)  shows  that  the  following  corrections  are  required  to  the  acceleration  level,  in  addition  .to 
■taaurabla  thruat  aooalarationi 

(1)  Acceleration  due  to  mase  attraction!  ?„■ 

(11)  Coriolis  acceleration:  33  x  v 

(111)  'fangintial  aooeleratlon:  3  x  r 

(iv)  Centripetal  acceleration:  3  x  (3xr)  , 

If  tha  aanaltlva  asaa  of  the  lensori  do  not  coinolde  with  the  txee  of  the  navliatlonal  coordinate  ayetem,  the 
senior  outputs  must  be  transformed  with  the  orientation  matrix  (&]>, 

Figure  3  ahowa  a  senaral  blook  diagram  of  navigation  ayatemi,  inoludlnp  thr  oorrsotlonu  Juat  mentioned  for  a 
rotating  frama.  Redundant  data  may  enter  tha  ayatem  at  levels  3,  3a  and  3b.  These  Input  date  cohaiat  of  the 
oorreot  values  end  errors.  The  errors  oen  be  bias  values  or  stoehestio  prooeaiee  or  a  combination  of  both. 
Consequently  the  navigation  information  is  erroneous  toe. 

The  following  two  problem!  suit  be  solved  in  order  to  use  the  available  redundant  information  In  the  best 
possible  way: 

(*j  Determine  the  desired  output  information  with  minimum  errori  (minimum  varlur.ca).  Thin  la  a  fllttrlng 
or  estimation  problem, 

(b)  Control  the  systaa  error  state*.  This  task  la  a  ayatem  control  problem. 

Both  teaks  are  accomplished  with  e  minimum  variance  or  Kelmin  filter,  Tank  (»)  require!  valid  mathematical 
mode  la  of  the  different  error  ecuroii,  Teak  (b)  ie  mcuoepllehed  by  feedback  loope  (inside  tha  computar)  as 
Indicated  In  Figure  2  by  dotted  lines. 

Before  thaaa  two  tasks  are  discussed  in  mors  detail  In  Section  8,  tha  error  behaviour  of  pure  inertial 
ayatama  and  tha  conventional  methods  of  updating  are  considered.  . 


S.  DETERMINISTIC  ERROR  ANALYSIS  AND  ERROR  BEHAVIOUR 

OF  PURE  INERTIAL  SYSTEMS 

In  a  pura  lnartlal  ayatan  thruat  aooalaratlon  rapraaanta  tha  only  input  foraation  aaamurad  at  tho  first 
level.  In  moat  casts  tha  Input  axaa  of  tha  aantora  are  parallel  to  the  axes  of  tha  navigational  coordinate 
frame.  If  this  Is  not  the  oast,  a  coordinate  transformation  la  neons ery. 

rigure  4  ahowa  tha  block  diagram  of  a  pura  lnartlal  ayatem  used  for  navigation  ovar  the_surfare  of  the  earth. 
In  this  oast  tha  velocity  V  of  a  vehiola  1*  doflned  aa  the  rata  of  change  of  the  vector  r  with  respect  to  the 
earth  (v  *  <d?/dt)f).  Therefore,  Instead  of  Equation  (2.4),  «e  now  have  tha  following  relation  for  aooalaratlon 
oorreot  ions:  . 

i>  =  (27I  *  •+  *a  “  (*“  »P>  x  V  ;  (3.1) 

3(  »  aarth  rat*  vector 

~/i  a  3.3,°  rets  veotor  of  the  navigational  coordinate  frame  with  reepeot  to  an  earth-f U«d  frame. 


where 


Ai  ihown  in  Figure  4,  e  foetlhack  loop  oxl*tu  owing  tn  llm  gravity  vector  g  ,  i,».  the  synt.om  in  oupuble  of 
oscillating.  The  oscillation  occurn  with  the  Schuler  period 


The  irror  bolmvlour  of  n  pure  Inertial  system  in  a  Schuler-tuned  mode  will  now  he  dlscueeod11, 

Figure  9  shows  the  error  block  diagram  for  one  horizontal  oliannel  of  each  a  eyntem.  The  errors  oonnidorod 
ere  soeelerometor  bine,  gyro  drift,  and  aglmuth  misalignment. 

The  following  notation  le  unad  in  Figure  B: 

Ar,  =  computed  velocity  errur  in  x-direetion 

Ar,  -  computed  poaltlon  error  in  x-directlon 

V,  =  x-aocolerometor  bits 

ij  =  fixed  drift  of  the  y-gyro 

cpy  a  y-oomponant  of  the  error  angle  veotor  between  the  navigational 
and  platform  coordinate  frame, 

i ■  g-ccnponent  of  the  error  angle  veotor  betwoen  the  platform  and 
computer  coordinate  frane  (azimuth  minalignment). 


0,3) 

(3.3) 


The  characteriatio  equation  (denominator  of  Equation  (3,3))  ia  that  of  an  undamped  aeollletion  with  Schuler 
frequency.  Far  aonatant  aenaor  errors  the  ateady-etati  value  of  the  veluolty  error  ie 


^il.eo  =  -^<«y  +  w*^i>  •  <>•*) 

The  poeltlon  error  U  oonetently  lnoretalng  with  time, 

^ra|e«o  00  i  (3.  S) 

end  it  ll  unbounded  owing  to  gyro  drift  and  azimuth  misalignment;  acceleroeeter  bias  does  not  oauiw  an  unbounded 
poeltlon  error. 


4.  DETERMINISTIC  UPDATING  METHODS 

Although  Sohuler  tuning  le  of  greet  iaportance  in  navigation  over  the, lurfaoe  of  the  earth,  it  hae  been  ihown 
that  for  longer  aleeion  time*  the  position  errors  can  become  intolerably  large,  especially  because  of  gyro  drift 
and  asimuth  error.  To  avoid  this,  the  pure  Inertial  eyiteo  can  be  aided  with  additional  or  redundtuii.  navigation 
inforaatlon  from  other  aourcee.  Available  continuous  or  dlesrete  data  for  the  navigation  computer  may  be  of 
levels  3,  3’  and  3b.  No  additional  Information  on  level  1  li  available,  because  wa  do  not  know  any  othwr 
method  of  measuring  acceleration  exaept  by  Inertial  asans. 

Aeoordlngly  wa  distinguish  different  kinds  of  aided  gyateaa: 

(i)  Vaioouy  aided  ayetemw  (redundant  data  at  level  3). 

(11)  Position  aided  ayatems  (redundant  data  at  level  3a). 

(ill)  Stellar  monitored  eyateas  (redundant  data  at  level  3b). 

Civ)  Stellar  monitored  and  velocity  damped  aysteme  (redundant  data  at  lavels  3  and  3b). 

The  additional  or  redundant  data  can  be  Intermittent  and  used  to  replsoe  the  computed  data  at  oertain  time 
periods.  If  It  la  alwty*  available,  It  can  be  continuously  compared  with  the  computed  Information:  the  differ¬ 
ence  signal,  multiplied  with  varluus  gains  Kp  ,  oan  be  added  to  the  accelerometer  output  signals  or  the  gyro 
torqulng  oommsnda  either  directly  or  over  additional  Integrators,  if  the  difference  or  error  signal  Is  intro¬ 
duced  at  the  next  lower  level  it  la  used  to  damp  the  oacillationi  of  the  system.  If  it  ii  introduced  at  the 
aaae  level  inside  the  Schuler  loop,  then  the  frequenoy  and  amplitude  can  be  changed.  If  additional  integrators 
are  used,  aenaor  biases  can  be  obmpeneated. 


•m 


Figure  6  ahowi  th»  x*ohann»l  uf  >  Sohuler-tunid  eyetam  and  tha  maohanliiaUon  of  tho  different  updating  method*, 

Thtsa  lathed*  art  now  dleuuasad  In  mar*  detail,  whtrt  Doppler  velocity  li  available  as  redundant  inf armnt  Ion, 
The  Doppler  velocity  signal  cannot  vary  wall  ba  uaad  to  reset  th*  inart lk  1  velocity  signal  diractly  bacauaa  or 
lti  high  nalaa  lava  1 ,  Tha  direct  resetting  tasthod  ia  not  vary  usaful  and  ia  only  applicable  it  angular  meaaure- 
aanti  or  position  fix**  are  avatlabla. 

A*  Figure  8  tndloataa,  tha  dlfteranoo  algnal  can  ba  uaad  to  provide  tinea  different  correction  aianala,  CL  ,  r, 
and  C,  ,  into  the  Bohular  loop. 

The  flrat  algnal  C(  ,  tha  difference  algnal  multiplied  with  tha  gain  factor  K,  ,  la  added  to  tha  aooelero- 
aatar  output.  Thla  prnvldea  damping  of  the  Bohular  onolllation.  The  aeoond  algnal  C,  ,  the  dlffaranoa  algnal 
■ultlpllad  with  the  gain  factor  Kj/r^  ,  affecta  tho  oeolllatlon  frequency  by  adding  to  It  the  gyro  input,  The 
third  input  Ca  provldea  oooipanaatlon  for  acme  eteady-etate  error*  of  veloolty  by  introducing  an  additional 
lntagrator  with  gain  Kj/r0  . 

Aaaueing  that  both  the  computed  inertial  and  the  measured  rnferenoe  volcolty  are  aubjeoted  to  errors,  the 
three  oorreotione  oorreipondlng  to  th*  x*channal  error  block  diagram  can  be  writtin  aa  followai 


'lx  “ 

“  <vex“vrx>  “  “  HJAr.-Jv,! 

(4,1) 

'll  * 

(Ar,  -  Sv,) 

(4.3) 

'»a  * 

—  f(v#1-vrlt)  dt  a  f(Ar, -8v,)  dt  , 

ro  ' 

(4.3) 

a 

where  Ar,  and  8v,  rapraaant  tha  arrora  of  tha  cqaputad  inertial  and  tha  ateisurid  Doppler  rafaranua  veloolty, 
reepeotively. 

Figure  7  ahowa  tha  x-channtl  error  block  diagram  of  tha  Copplar  Inertial  eyatea  doaorlbed, 

Tha  trsnstar  funotlona  of  tha  velocity  and  politico  arrora  oan  be  derived  from  Figure  7  aa  followai 


Ar,  a 

•,7X  - ..!«*<«» +  +  +  +  •'•'»}*»* 

(4.4) 

•’  +  Kja1  +  (1  +  K,)ajJa  +  K,wJ 

Ay,  n 

•*7a  -  •*«,**&)*  K (*»■+«,.)  +  »**|)»*R 

(4.8) 

eCa1  +  Rj**  +  (1  +  K,)cc*a  +  K,wjl 

’xls.c  H 

5v,  . 

(4.8) 

Equations  (4.4)  and  (4.8)  oan  ba  uaad  to  evaluate  tha  valooity  and  poaltlon  arrora  for  different  valuaa  of 
Kt  ,  K,  and  K.  ,  or  to  obtain  optimal  value*  of  the**  three  gain  factors .  Th*  gtiedy-atat*  valooity  actor 
no*  oontalni  tha  reference  valooity  arror  5y,  only  (Equation  (4.8)).  7li*  fixed  ayro  drift  and  anlmuth  error 
era  ooaipanaatad  by  th*  additional  Integrator. 

Figure  8  ahowa,  aa  an  example,  th*  tig*  function*  of  th*  valooity  arror  du*  to  gyro  drift  for  th*  pur* 

Inertial  eyeten  (K,  a  K,  n  K,  «  0)  and  for  th*  different  method*  of  updating  (K,*0;  K,  and  K,  4  0  and  Kt.K,,Kt  ¥  1), 
In  thla  example  only  th*  influence  of  tha  various  gain  faotore  K*  on  the  arror  behaviour  Ar,  arc  of  interest, 
and  not  tha  value*  of  these  faotore  thtaeelvii.  This  meant  that  the  choaen  valuta  of  the  gain  factor*  cannot  be 
considered  as  optlatl  value*,  lurthersore,  an  exact  definition  of  “optimal"  has  not  been  given  so  far,  bsosue* 
only  on*  error  souroe  Is  taken  Into  account.  Th*  problem  of  optimal  gaina  ia  diaouiesd  in  Ssotlon  8. 


8.  HATH T ICAL  ERROR  ANAIYSIS  AND  ERROR  BEHAVIOUR 

go  far  aonatant  errors  (b lease)  hava  bean  discussed,  but  in  aany  oases  tha  errors  are  not  constant,  but 
rather  stochastic  prootssta  character i*»d  by  their  sutcoorrelatioo  funotluns  pv  (t)  or  thslr  epeotral  density 
funotlona  s6„(w)  . 

For  Unaar,  non-tlaa-varylng  ayetema  th*  ntatlitloa  of  the  output  tlgnal  y(t)  follow*  directly  from  th* 
tlae-lndependent  statistics  of  th*  Input  algnal  x(t)  .  Th*  mean  value  of  the  output  signal  le  aero  If  tho 
mesa  value  of  th*  Input  eignal  ii  aero.  Tha  average  value  of  th«  square  of  th*  output  signal,  the  tine- 
dependent  varleno*  ,  oan  be  ooaputed  by  th*  expression’ 

°y<i>  s  /0t/0t|Cr,lgfr,)A),(|T,-’-a|)  dTjdr, 


(8.1) 
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trror  art  lnveraely  proportional  to  K, .  Theso  far.ta  live  additional  criteria  for  K,  .  If  K,  and  K,  are 
alao  VO  ,  it  la  difficult  to  obtain  a  closed- form  aolutlon  of  Equation  (8.7).  In  this  out  a  computer  program 
any  be  necessary  to  evaluate  tho  Integral  and  to  obtain  oriterin  for  the  valuer  of  K,  and  K,  . 

8.  STATISTICAL  FILTERING  AND  UPDATING 

The  updating  miobanlao  described  in  Section  4  used  a  deterministic  approach.  The  advent  of  vory  powerful 
navigation  onmputera  nndn  It  poaiible  to  retrieve  more  of  the  information  contained  in  the  navigation  moaHure- 
Bcnta  by  applying  statistical  filtering  techniques. 

In  thla  aaction  the  problem  of  optimal  estimation  and  control  of  aided  Inertial  ayeteni  state  variables  ia 
dlacueaed.  Although  the  problem  of  optimal  eetlmation  and  filtering  le  actually  a  falily  old  one,  It  has  only 
recently  yielded  a  decisive  breakthrough  by  Kalman  and  others.  Tho  classical  theory  of  Wiener  and  Kolmogororf 
baa,  as  an  essential  disadvantage,  operation  with  the  difficult  formalism  of  Integral  equations.  Thu  Kalmun 
discrete  filter  equations  ere  purely  elgebreic;  hence  they  are  particularly  well  suited  for  prooeeslng  on  modern 
digital  computers  Common  to  both  theories  la  the  fact  that  they  are  applicable  only  to  linear  systems  und  that 
they  make  uae  of  the  same  criterion  of  being  optimal,  naaoly  the  smallest  mean  square  error.  .  Moreover,  thore 
exists  an  Interesting  connection  between  the  two  theories:  if  the  hiener-liopf  equation  Is  extended  to  non-atatlon- 
sry  processes  and  presented  In  matrix  form,  It  is  an  exact  analogy  to  tho  orthogonality  thcorom  of  tho  optimal 
Kalman  filter  equations'.  This  orthogonality  theorem  states  that  the  moan  square  estimation  orror  henones  n 
minimum  If,  and  only  if,  the  measurement  trror  and  the  estimation  error  nf  the  syatem  state  arm  orthogonal  to 
each  other. 

Inertial  navigation  systems  can  be  expressed  mathematically  by  nonlinear  differential  equations.  But  the 
navigation  errors  are  well  deacrlbable  by  linear  differential  equation!  using  only  the  first  terse  in  the  aeries 
expansion  about  the  nominal  values.  Tho  error  sources,  for  example  gyro  drift,  aooelerometer  bias  etc,,  appear 
as  forolng  functions.  If  these  error  sources,  as  wall  as  the  srror  sources  of  the  reference  measurements,  are 
considered ‘as  statistical  variables  with  sera  aeons  and  known  Jccond-ordtr  moments,  then  the  modern  Kalman  theory 
of  optimal  filtering  applies  vary  wall  to  sldtd  inertial  systems.  In  this  way  optimum  dee  is  made  of  the  extsrnai 
aaseurementa  as  additional  Information  and  of  ths  known  statistics  of  the  error  sources,  to  obtain  tho  optimal 
•ystea  gain  factors  for  every  time  inetant  and  to  keep  the  navigation  errors  aa  small  aa  possible.  It  is  import* 
ant  to  recognise  that,  contrary  to  tho  conventional  updating  methods  described  In  Boctlon  4,  the  gain  factor!  are 
mot  constant.  They  are  recomputed  Id  every  Kalman  cycle  in  order  to  use  the  redundant  information  in  the  optimal 
way  within  the 'iystsm. 

The  Kalman  filtaring  theory  and  the  darlvation  of  the  equations  is  fully  dlsouessd  elsewhere  (References  A, 

13,  4,  14,  eta.)  and  can  tharafora  be  deleted. 

The  aoet  important  propartias  of'  a  Kalman  filter  osu  be  summarised  is  follows: 

The  filter  estimates  tre  ell  variables  of  the  state  vector  in  the  least  moan  square  error  eenee. 

The  estimation  is  baead  upon  statistical  data  of  all  arror  aouroaa  and  ia  oosplataly  oarrlad 
out  in  tho  time  domain. 

Tha  filter  formulae  satisfy  minimum  variance  orttsrla  for  all  problem  parameters, 

The  foraulae  implemented  are  recursive.  This  means  that  the  optimum  estimate  for  the  time 
being  can  bs  computed  from  the  previous  estimate  and  the  currant  observation  without  recourse 
to  earlier  eatlmatea  or  observations. 

Tho  recurs lve  formulae  are  well  suited  to  digital  computers. 

The  basio  method  of  using  a  linear  optimal  filter  sithin  in  aldid  inertial  ayatem  is  shown  in  Figure  D. 

The  two  upper  blocks  in  Figure  9  represent  s  pure  inertial  system.  The  navigation  equations  are  mechanised 

in  tbs  navigation  computer  in  the  conventional  w*y.  Component  Ion  for  eonsor  blaaei  may  be  lnoluded  in  tha 

navigation  equations. 

Thg  information  available  in  the  navigation  computer  is  compared  with  redundant  asternal  data.  The  differ¬ 
ence!  era  tha  measurement  .data  used  in  tha  filter  to  improve  the  estimate  of  the  system  states. 

Than  error  eetlaste*  of  the  filter  may  bn  used  either  for  updating  the  navigation  information,  and  thus  for 
oorrsotlon  of  IIW  arrora  (closed  loop  operation) ,  or  only  for  improvement  of  the  error  states  (open  loop 
operation)9.  The  blook  "controller"  regulates  this  operation. 

If  an  Inertial  navigation  system  it  mechanised  in  the  open  loop  operation,  til  errors  and  their  external 
Maauremoats  oan  be  represented  by  a  set  of  two  linear  vector  equations 

xft)  =  A£t]x(t)  +  nTt)  (9.D 

Tit)  =  «£tjx(t)  +  Tit)  .  (8.3) 
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Equation  (4,1)  la  tha  ayatom  aquation.  It  describes  tin  propagation  of  all  error*  ooourrlnB  In  an  aided  navign- 
tlon  ayaten,  The ^loaonta  of  the  nxn  matrix  A£y  are  known  functions  of  time.  The  components  of  tlio  white 
nolae  veotor  n(t)  represent  tho  forolna  functions.  Equation  (9.11)  is  thejneasurement  equation.  It  relates  • 
tha  values  of  tho  error  state  veotor  to  tho  moaauronont  data.  The  vootor  qTT)  represents  tho  disturbing 
white  noise  of  tha  external  measurements. 

It  la  an  essential  supposition  of  tho  Kalman  filter  theory  that  the  vector  differential  equation  (0,1)  can 
ha  solved  hy  the  samo  method  uaed  for  deterministic  differential  equations,  namely  tho  conventional  Picard 
Iteration11.  The  so-called  transition  matrix  'ht/t0  .  which  plays  a  fundamental  role  In  tho  whole  theory,  appoars 
In  this  solution.  Using  this  faot  and  divldlng~tlie  time  axis  into  equally  spaced  discrete  Intervale  (the  sampling 
times  of  the  computer)  the  dynamics  of  tho  linear  system  under  consideration  can  be  desorlbcd  In  the  form 


XVI  s  ^KVl/X**  + 

hr  hh  +  «£  • 


xK  a  system  error  state  vector  at  time  tK 

.  /k  =  nxn  state  transition  matrix,  relating  tho  state  vectors  xj^  and  x^ 

In  the  nolso-freo  case 

w  .4 

hx  3  additive  whito  noise  aaquenoe  representing  the  forcing  funotion  in  the 
dynamic  system 

(Note:  If  Equation  (8.3)  wars  prasentsd  In  the  continuous  fora,  then  tha  veotor 


/*  iLUJ 


n(r>  dT  , 


aa  tha  response  of  the  system  to  the  white  noise  input  n(t)  ,  would  be  a 
oorrelatsd  random  process,  But  in  the  discrete  form  the  values  of  the  integrals 


■ftUtn.T)  nfr)  dT 


for  different  K  are  independent  of  each  other;  therefore  the  veotor  h(  can 
be  represented  aa  a  whits  noise  sequence  with  the  property 

E[hKh^]  a  fJjSxp)- 

yjj  *  observation  veotor  of  measurement  data  at  ties  t„  linearly  related  to  xK 

Mg  =  esn  measurement  matrix  at  time  t(  relating  to  xj  In  tha  noise-free  oaae 

qjj  e  additive  white  noise  saquenos  corrupting  measurement  data  at  time  t„  . 

The  following  five  baalo  equations  represent  the  Kalman  filter; 

*x  =  *x  + 

*X*I  a  ^Xtl/XXX 


5|  =  3!i(Ki!!i[+Si>“ 
h  --  <I-bS)S 


x{  ■  a  priori  estlaate  of  the  ayatee  etate  vaotor  predicted  at  tine  tR 
before  using  redundant  measurement  data 

£  m  o  posteriori  estimate  of  the  system  state  vector  at  time  t(  after 
using  redundant  measured  data 

A 

P|  s  nxn  covnrinnct  antrix  of  tha  a  poittriorl  estimation  arror  xK  -  x( 

Pj  «  nxn  oovnrltncs  matrix  of  tha  a  priori  sntiantion  arror  xj  -  xj 

Hj  a  gth^ij7]  a  nxn  covarlanoe  matrix  of  the  ayatsm  white  nolle  veotor 

Qg  a  s[q^q^T]  :  in  oovarlanoe  matrix  of  the  measurement  white  noise  vsetor 

B.  a  eelihtlns  (sain)  matrix  it  tlmi  t.  . 
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These  equations  are  procinnod  o.n  an  iterative  banla  to  determine  consecutively  the  optimum  estimate  xj|  of  the 
syetea  etite  it  time  tK  ,  The  mechanUation  of  an  aided  inertlnl  navigation  system  in  tn  open  loop  oporntion 
ie  Just  doiorlbed  le  not  satlifactory,  eipeoiilly  for  long  minions.  The  output!  of  the  inertial  navigation 
eyatem  oould  bo  corrected  by  eubtraotlng  the  eetlnatod  errors;  but,  elnoe  sods  errors  in  the  inertial  syitere  are 
sot  bounded,  the  linear  error  u:odel  of  the  navigator  would  become  invalid.  Tho  requirement  of  small  errors  and 
linear  error  propagation  can  only  be  achieved  by  controlling  tho  state  vector  in  the  closed  loop  operation. 

For  such  s  controlled  system  boss  of  the  above  equations  must  be  modified  slightly.  Instead  of  Equations  (0.1) 
and  (0.9)  the  following  equations  are  valid*: 

«(t)  =  A(t)mf  t  n<t)u(t)  +  nTtt  (o.io) 

XK*l  ~  l/K*K  +  ^KM/ltuK  ■*  hK  •  (8.11) 

The  terms  D(t)u(t)  and  represent  the  above  mentioned  correction  signals  entering  the  system  to  bo 

controlled;  in  the  ideal  cash  of  a  completely  controllable  system  the  matrices  D(t)  and  ere  of 

dimension  n>n  . 

The  modification  of  the  filter  Equations  (0,S)  to  (6,9)  results  in  a  slight  change  of  Equation  (6.6).  This 
result  le  noticeable,  slnco  the  original  equations  given  for  the  uncontrolled  system  are  derived  in  the  literature 
under  the  Important  aaaumptlon  that  the  mean  values  of  the  input  forcing  functions  are  zero,  i.e.  that  always  the 
condition  is  valid  E[n(t*)l  «  0  and  e[HJ|]  s  0  ,  respectively.  In  the  controlled  system  the  condition  of  zoro 
Men  velum  Inputs  la  not  tohlavad,  because  now  the  forcing  functions  consist  nut  only  of  the  white  nolee  vectors 
nftl  or  h,  ,  but  also  of  control  signals  which  are  trsatsd  as  known  deterministic  functions,  btstd  upon  ths 
oomputsd  sstlmats  of  ths  stats  vector,  in  most  cases  ths  condition  of  E[D(t)u7t)J  a  0  or  E[rifl/»'ujP  =  0 
is  not  valid  for  the  control  signals,  beosuss  ths  estlaatur  xj  is  unbiased  and  ths  Initial  vs'  [WHStxJ]  docs 
not  need  to  be  zero  (Section  D1  of  Reference  13).  Nevertheless  it  is  obvious  (and  can  bs  shown  by  minimising 
tbs  Man  square  estimation  error  (Seotlon  C  of  Reference  13),  that  the  modified  Equation  (6.6)  now  becomes 

rM/l^  •  <«•»> 

Equations  (6.10)  to  (6.12)  would  be  valid  if  all  components  of  ths  stats  vsotor  were  oontrollable.  Unfortunately 
the  Ideal  case  of  complete  controllability  la  not  possible  in  an  inertial  navigation  system.  The  oontrollnblo 
states  are  in  most  oases  restricted  to  errors  In  position,  valooity,  and  platform  orientation.  Ths  sffsets  of 
ths  othor  variables  osn  also  be  removed  by  including  compensation  signals  in  the  oontrol  signals,  based  upon  ths 
Kalman  filter  sstlmatei,  but  nevertheless  these  variables  are  not  controllable  In  a  striot  sense,  bsoauee  they 
srs  not  soosssible  to  dirsot  measurements  ami  oorrsotlons. 


In  an  inertial  navlsatlon  system  ths  state  variables  are  usually  soparatsd  Into  two  parts,  ths  first  one 
oontsinins  the  controllable  states,  the  other  one  ths  uncontrol lsbl*  states.  Thus  ths  dynamics  of  such  a 
system  cm  be  described  in  the  following  fora! 


The  control  signets  for  the  time  interval  from  tK  to  t(tl  should  be  based  upon  the  best  estimate  of  the 
•tste  veotor  xj  available  at  time  tK  .  But,  since  at  thin  point  in  time  a  new  measurement  in  made  and  the 
oomputation^of  the  weighting  matrix  D,  by  Equations  (0.7)  to  (6.9)  rsquirss  sons  time,  the  a  potttriori 
estimate  x^  cannot  be  available  at  t|e  time  Instant  t,  ,  Therefore,  ths  control  signals  ni*i/»u«  must  bo 
oomputsd  from  the  a  priori  estimate  xjr  , 

Considering  the  faot  mentioned  above  and  ths  so-aalled  separation  theorem’ ,<it  the  following  rolstion  can  be 
derived: 


Subetltutlng  Equation  (6,U)  into  Equation  (6.12)  the  a  priori  and  a  posteriori  estimates  of  ths  separated  state 
vector  In  the  Kalman  equation*  are  represented  by  the  following  equations; 


m 


*i*i  1  fog^/gWyg-rp 

— — * 

*«*i  * 


(0.16) 


*  Note:  It  la  peralaaible,  in  order  to  aak*  the  traaaition  from  Equation  0.10)  to  (6.11),  to  oorsidar  the  victor  u(t*  u 
a  constant  u( tK)f  »  ujj  ovar  the  Kalaao  oyolt  interval.  Thi  term  1'k » i / I"  tl',n  glv*n  by  tha  expreaaion 
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(6.16) 


Boat  remark*  are  now  made  with  retard  to  the  etata  vector,  the  computation  of  the  transition  matrix 
computation  of  the  matrix 


and  the 


The  atate  vector  xj  must  inolude  all  important  error*  and  error  aourota  in  the  system  and  the  associated 
sensor*  which  cannot  be  represented  by  white  noise.  It  contain*  the  navigation  errors,  l.e,  errors  in  position, 
velocity  and  platform  orientation,  error*  of  the  inertial  seniors  and  their  respective  misalignment  on  the  plat¬ 
form,  and  errors  of  the  redundant  sensor*.  The  senior  errors  may  originate  In  the  sensor  Itself,  in  tho  environ¬ 
ment  or  In  th*  measurement  principle.  It  Is  important  to  nots  that  all  errors  whioh  con  be  repreaented  by  white 


tlBM  behaviour  of  the  latter  ones  must  be  deacrlbablo  either  by  linear  homogeneous  or  by  linear  inhomogenoous 
differential  equations,  so  that  they  can  be  Included  In  tho  system  of  Equations  (3.1)  or  (0.10).  Msny  of  tho 
uncontrollable  state  variables  are  supplements  to  the  state  vector,  necessary  when  tho  respeotivo  error  aourcoa 
ara  not  deacrlbable  by  white  noiso  aequences. 


The  most  important  trror  modal)  ara  Markov  prooaaaea,  random  walk*  and  oonatant  random  blue*, 
random  prooaaaas  can  be  generated  from  whits  noise  hy  linear  systems  (shaping  filter*). 


The  correlated 


The  Markov  prooeie.  whono  power  spectral  density  hss  the  form 

2 <y‘/3 


<t>M  * 


w*  +/3» 

oan  be  daeorlbad  In  the  time  domain  by  th*  linear  differential  aquation 

i(t)  +  /3f(t)  =  ✓(ao,/3)w(t)  , 

where  w(t)  ,  as  tha  driving  function,  represents  a  unity  vtriano*  whit*  noli*  aourcs. 


(6.17) 


(6.18) 


A  random  walk  prootaa  1*  obtained  as  th*  output  of  an  intairator  whose  input  la  whits  noli*.  Its  differential 
aquation  la  of  tha  fora 


f(t)  =  wr(t). 


(8.19) 


A  oonatant  random  blu  oan  alio  b*  described  by  a  linear  different ial  aquation,  In  foot  by  tha  most  slmpls  one 
whioh  sxlsts,  ntmly, 

f<t)  a  0  .  (6.20) 


Ita  aolutlon,  auppllad  with  a  random  Initial  condition,  raprvaanta  th*  daalrad  oonatant  blaa  error. 


It  oan  be  seen  that  thla  praotloo  of  aupplamsstlni  th*  atat*  vector  la  a  convenient  method  If  the  error 
aourae  forcing  function*  do  not  represent  uncorrelated,  zero-mean  random  prooaaaea.  Out  thla  prooodure  may 
lead  to  a  considerable  number  of  atat*  variables,  Since  the  conputstionil  extent  grows  excessively  with  the 
nuabsr  of  variables  (approximately  by  ths  third  powsr),  one  Is  often  constrained  to  consider  only  the  most 
Important  error  sources:  thla  Mina  to  "subopt lull*"  th*  syetaa.  Another  method  of  suboptimising,  whioh 
raaulta  In  a  procedure  similar  to  that  daicrlbad  above  for  tha  controllabla  and  uncontrollable  states,  la  tha 
partitioning  of  th*  stats  vector  by  piecing  the  variables  to  be  eliminated  in  one  eubavstem  and  ths  remaining 
variables  In  one  or  aora  additional  subayataas.  By  this  aaana  th*  correlation  between  th*  variables  in  differ¬ 
ent  aubaystaas  la,  in  fact,  Ignored  and  th*  satiaata  1*  aoaewhat  deteriorated  a*  compared  to  th*  optimal  oaae, 
but  this  reduction  of  tha  matrix  dimensions  result*  In  soas  saving*  In  computing  time  for  th*  approximate 
optlaal  weighting  matrix10.  In  every  case  of  dsilinlng  such  a  suboptiasl  system,  th*  performance  deterioration 
due  to  elimination  or  partitioning  of  sob*  state  varisbUe  should  be  predetermined  by  digital  computer  simula¬ 
tions  and  compared  with  optimal  reaulte.  For  example,  ualng  th*  method  of  partitioning  th*  etat*  veotor,  the 
“beat"  partitioning  depends  aleo  on  th*  eyetem  condition*. 


where 


The  computation  of  tha  transition  astrix  fy/tn  will  now  be  discussed.  It  Is  known  that  qit/tD  ctn  be 

liffersntlsl  “ 

=  &tt}0t/t 


n/tn 

obtained  from  th*  coafflolant  matrix  A(t)  by  the  dlffsrsntlal  equation1*’10 

<#t /t 
dt 


(8.21) 


(Identity  aatrlx) 


la  th*  initial  condition. 


In  the  general  case  an  axpliolt  olosed  solution  of  this  differential  equation  la  not  poislbls,  hut  an  Infinity 
aeries  oan  b*  derived,  whioh  converge*  uniformly  In  t  for  every  matrix  A(t)  .  Thla  solution  la  given  as 
follows11! 
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<f>t/t  =  I  +  f.t  +  f*  MrJ  (Tl  Mr.)  dr, dr,  +  f‘  Afr,)  fT‘  A(r^  P *  Mr.)  dr, dr,dr,  +  , , ,  (6. 

- 1  '‘o  na  —  o  "o  -  — 

la  the  ossa  of  constant  coefficients,  4  -  constant,  Equation  (6,23)  can  bo  transformed  Into  tha  fora 


22) 


t/t„ 


I  +  A<t-t0)  +  Af 


t.)  ♦  Af  (±Lhll .  =  .«***•>. 


(8.23) 


: 

m 


I  *v 
l»*Vi  . 

k! 


W 
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Thla  raault  out  alao  ba  darlvad  directly  from  tha  differential  Equation  (0.21).  However,  In  Boat  eaaea  the 
■atria  A  la  not  conatant,  at  least  some  of  the  elemonta  a,,  are  functions  of  tiac.  In  thoso  cases  the 
conputatlon  of  the  terns  In  Equation  (0.22)  la  laborious,  and  It  la  batter  to  subdivide  the  whole  Interval 
(t-t0)  and  to  consider  (  ai  a  constant  matrix  during  these  partial  intervale.  The  time-dependent  elements 
of  tha  nstrlx  A  are  now  approximated  by  a  staircase  function,  By  this  means  Equation  (8.23)  can  be  used  to 
conpute  tha  partial  transient  matrices  dtn/t„.,  and  it  oan  bo  shown11  that  the  matrix  ov#r  tha  whole 

interval  (t-t0>  la  aioply  the  product  of  the  partial  matrices  J>tI,/t0.1  •  ,  “ 


S 

t  *  tp  >  t„.,  >  t„.,  >  . 


"  ‘Vti“Vto  ■ 

>  t,  >  t„ 


(•>24) 


It  is  laportant  to  note  that  by  this  aathod  the  iteration  tiae  for  the  computation  of  tha  Hainan  aquations  doss 
not  need  to  agree  with  the  iteration  tlaai  for  coaputing  the  partial  aatrloaa  0tD/tB.t  >  Thw  essentially  longer 
oyole  tinea  for  tha  computation  of  the  Kalman  aquations  oan  be  chosen,  depending  on  the  spaed  of  the  available 
ooaputer  and  the  tinea  when  additional  redundant  aeasuramaatt  are  available.  The  aatrlx  d>K,  , /K  over  the  whole 
Kalaan  oyole  Interval  suet  In  theee  oaaea  be  oooputed  using  Equation  (fl.24).  It  is  of  grestiap'rtaoce  to  pay 
attantion  to  the  nuaber  of  partial  intervals  into  whioh  tha  Kalaan  oyole  Interval  la  divided.  If  it  is  tub- 
divided  too  finely,  the  linear  tarn  In  the  series  expansion  (8.23)  ii  sufficient  to  compute  tha  partial  aatrlx 
‘At,/t»„1  >  but  than  tha  oomputatlon  of  tha  total  aatrlx  nay  oonauaa  a  too  graat  portion  of  tha  avallabla 

computer  tins  bsoaust  of  tha  graat  nuaber  of  mu ltipllcatione  and  additions  contained  in  Equation  (6.24).  Thla 

is  upeclally  trua,  whan  tha  atata  victor  containa  aany  variables,  It  la  often  better,  with  regard  to  canputlng 

tiae  and  alao  with  regard  to  aoeuracy,  to  subdivide  tha  Kalaan  cycle  for  coaputatlon  of  tha  partial  aatrioas 

0^,,/tn-i  la»»  finely  and,  Instead,  to  taka  tha  quadratle  tars  of  Equation  (8.23)  into  sooount.  Tha  aatrlx 

for  tbstime  interval  tp.,  to  tp  oan  than  ba  approxisuited  by  tha  aquation  8  0-1 


*»./>.„  91  1 +  +  • 


(8.28) 


Ear  every  systea  it  la  naoaaaary  to  dataralna  which  of  tha  two  Methods  la  batter  in  a  practical  caaa.  Probably 
tha  first  method  (finer  subdividing  and  ounaideratiou  of  only  tha  linear  tern)  la  to  be  preferred  in  a  real 
system,  in  whioh  the  matrix  A(t)  axy  change  vary  quickly,  whereas  tha  second  aathod  la  to  ba  preferred  for 
•yatam  parforaanoa  trror  analysis,  where  comparatively  alow  changes  of  tha  aatrlx  M)  ocour, 

Tha  ooaputatlon  of  tha  aatrlx  oan  ba  darlvad  froa  the  vaotor  hj  aa  follows: 

3  f,teM  ^(t<tl,T)n(r?  dr 

i  1  ■  ■[t^»ft.e1.rt)5vT  *•,  I*™  i><VT<fr<WT»>Tdrs  j- 

Interchanging  tha  order  of  averaging  and  integration,  and  defining  tha  covariance  aatrlx  of  th*  white  noiaa 
vector  n(t)  aa 


(8.28) 


one  oan  writs  further 


gCn(t,jn(t,),T]  =  «(t,)  5(t,  -t,)  ,  ' 

Hg  =  0(ttft,T1)N(r1)  dr,  Qtl  i( r,-  T,)0(t,.,.r,)*  dr, 

=  ji(ttM,T)N(T)q!i(t|ln,r)T  dr  , 


(8.21) 


(8.28) 


In  itnaral,  Equation  (8,28)  aust  ba  approximated  by  nuaarioal  methods.  For  exaaple,  if  Nft)  is  considered  a* 
a  conatant  aatrlx  N.  over  tha  whole  Kalaan  Intarval  (tKtl  —  tK )  and  if,  according  to  Equation  (6.24),  this 
intarval  la  divided  Into  an  even  nuaber  p  of  sub-intarvala  of  equal  langth  At  =  t,t,  -  t,  ,  than  Equation 
(6.28)  oan  vary  wail  ba  approxiaatad  by  31apeon;  a  rula: 


.•« . 


*■' 


U( 

^  *  3  ^_tKfL,'_Vtp«l  *  *  ‘  ‘ ' *  ^KH*  Wt  + 

+  ^Kh'Wi  ' ' '  '  ‘ ‘  Nn’Wi  + 

+  ?ft»M*tp/S-l  ' ' '  ‘Vv^iS  ‘ ' '  ‘Ntn'Wi  + 


3^tK-M*tp‘/tp-i^t.c-t/'t8-iNK;Stp-i^tP“)lili>tKn*tp/ltp-i  + 

+  4i/>l  .»  /»  Vt  +  N.)  .  (8.29) 

.  ‘X.L'V-Vl _? .Vl’VVl 

Of  oourat,  thia  aolutlon  out  only  b#  of  thaoratical  lntaraat  if  p  >  2  ,  btetuit  th«  computation  of  Equation 
(8.29)  biooMi  too  laborlou*.  In  moat  gun,  it  nil!  b*  aufftoWnt  to  approximate  Equation  (8.24)  by  tha 

alapla  axpraoaion 

h  “  •  <«‘so> 

No  stnaral  aapraaalon  nan  ba  darlvad  far  tha  mueaurtaent  aatrix  1L  ,  baoauaa  it  dapandi  upon  tha  aaohaniaad 
ayataa  and  tha  aoda  of  oparation. 

In  Motion  8  of  thia  ohaptar  the  oonvantlonal  atatlatioal  arror  analyaia  of  aidad  inartlai  ayatama  warn 
daaorlbad.  With  tha  aid  of  tha  Hainan  flltar  aquation.  a  atatlatioal  performance  analyaia  with  minimum  arror 
varianoaa  can  ba  aooompliahad  vary  affaotlvaly.  for  auoh  an  analyaia  only  tha  laat  thraa  of  tha  fiva  Kalaan 
aquatlona,  naaaly  (8.7)  to  (8.9).  ara  raquirad.  It  it  an  advantaia  that,  in  an  Idaal  controllnd  ayatau,  tha 
aatrix  Pj  ilvta  tha  varianoaa  of  tha  atataa  thaaaalvaa,  aithar  diraotly  or  altar  aiapla  tranaformatlona,  for 
in  auch  a  ayataa  tha  arror  atata  varianoaa  will  ba  raduoad  to  a  laval  aqual  to  the  variance  with  which  aaoh 
abate  ia  eatiaated.  Therefore -the  f allowing. definitiona  ara  valid  tor  tha  aatrix  pJ  t 


Uwontrolleif  ayataa 
(open  loop  oparation) 

$  .  *tfii-xjf><*x-*x>TJ 


Idttl  controlled  tyi tarn 
(oloiad  loop  oparation) 

p*  •  ■DESf*]  . 


A a  pointed  out  aarlltr,  no  idaal  oontrollablo  ayataa  axiata  in  reality.  But  a  relation  can  alto  ba  darlvad  for 
tha  oovarlanoaa  of  tha  controllable  atataa  of  a  real  ayataa,  in  whiob  tha  atata  vector  ia  aeparated  into  con¬ 
trollable  and  unoontrollabla  atataa,  aa  ahown  ill  Equation  (8.  IS).  By  auoatltutlng  Equation  (8.10  into  Equation 
(6.19)  with  negative  aim  (uorraaponding  to  tha  way  in  which  tha  control  aignala  autar  tha  ayataa)  the  following 
relation  ia  yielded! 

—  3-5*  - 

*4*.  -  frjiiajflW  ■  +  •  «•»> 

*r  "  Ha 


Fro*  Cquttion  (0.33),  finally, 

*txT,  x^  Ti 


l^i/x^^i/x  +  i5fc 


It  a  abort  Hainan  oyola  tlaa  la  conaidered,  aa  coaparad  to  tha  time  conatanta  of  the  navigator  and  tha 
aaaoclatad  arror  procanaea,  tha  aatrix  doec  not  differ  auoh  froa  tha  identity  aatrix  and  tha  aatrix 

i /.  la  near  xaro,  Baaldaa,  tha  vector  hj  la  aero  in  all  practical  qaaea,  baoauaa  tha  randoa  forcing 
funotiona  of  tha  aontrollabla  atataa  conalot  of  oorrilatad  error  aouroaa.  Therefore  tha  appropriate  part  of 
Ft  can  ha  uaed  u  a  good  daaorlptlon  of  tha  aotual  oovarlanoaa  of  the  controlled  atataa.  Doing  thaaa  facta 
It  la  not  naoaaaary  to  carry  out  the  lolutlon  of  Equation  (8. S3),  and  tha  computational  burden  during  perform- 
anoe  analyaia  can  fc«  reduced  aubatantlally. 

The  arror  behaviour  of  an  aidad  navigation  ayataa  will  now  ba  invaatigatad,  ueing  tha  method  daaorlbad  for 
ayataa  performance  analyaia.  It  ohould  ba  noted  that,  by  thia  method,  optimal  yaluea  for  tho  element*  of  tha 
weighting  aatrix  ara  autoaatloally  oonputed,  In  contraat  to  tha  oonvantlonal,  dateralniatlc  method 
daaorlbad  in  Section  4,  tha  affeota  of  thaaa  gain  factor*  will  certainly  b*  more  complex,  alnca  they  do  not 
enter  tha  ayataa  at  a  aingl*  definite  place,  but  baoauaa  they  influence  in  an  optimal  way  every  ayatau  mtate. 
Accordingly  they  ara,  ot  court*,  not  exactly  equivalent  to  tha  formerly  uatnl  dataralniwllc  gain  faotorn  K,  ,  K, 
or  X,  ,  for  it  la  atally  poeaibl*  to  include  tnaaa' factor,  alec  in  tha  matrix  Aft)  of  tho  nyatem  Equation 
(6,1)  or  (8.10),  reapaot ivaly,  and,  in  addition,  to  oarry  cut  a  Kalman  filtering.  Tha  waning  of  tha  matrix 
•w  ia  mort  ooaprahanalv*  and  nor*  profound.  Mathematically  B^  ha*  the  tuak  of  walghting  tha  aatimatea  with 
tha  redundant  aaaaurtaanta  and,  Ij^lhe  optimal  oaaa,  of  aatmbllahlng  an  orthogonal  relation  bemoan  the  linear 
independent  random  vaotora  xl  -  x,  (aatlmation  error)  and  yj|  -  yj  (maaaurannt  arror),  and  thua  to  aocompliah 
the  orthoxonallty  theorem  mentioned  aerller. 
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Figure)  10  and  11  ahow  th*  propaeetion  of  the  poult  Ion  and  velooity  error*  of  an  Inortlil  navigation  eyeteio 
in  different  modes  mod  to  navigate  over  the  surface  of  the  earth,  It  can  be  aeon  that  here  alao  conaidtrable 
Improvement  of  the  aocuracy  can  ho  obtained  by  additional  redundant  informations,  aa  compared  to  pure  inortlul 
navigation,  Tha  velooity  error  in  tha  pura  Inertial  mode  allow*  tho  oharaotarletio  sohuler  period  and  the 
34  hour  period,  In  oontraat  to  Figure  6,  not  only  the  influence  of  a  elnglo  error  aouroe  but  the  entire  influence 
of  ell  error  aouroee  Is  canoidared.  Thu  Influence  of  any  single  error  aouroe  oould  alao  be  Investigated  by  a 
change  of  the  method  deacrlbod  for  tho  system  performance  error  tnalyele,  hut,  alnoe  thla  la  on  ohjoctive  of 
auboptlmal  itudlea,  It  will  not  be  dlsouaaed  further. 

In  thi»  axnmple  the  itatu  veotor  cotiMete  of  24  vorlahlee,  The  flret  7  etatea  are  tho  well-known 
oontrollebla  Inertial  navlgutlon  errors  wheee  propngntion  equations  art  derived  In  aeveral  textbooks  (References 
7,  11,  etc, ).  The  other  variables  aro  the  uncontrollable  error  eoureos  whioh  cannot  be  represented  by  white 
nolee, 
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Inputs 


Outputs 


Inertial  Acceleration 
Ground  Speed(Ooppler) 

Air  Speed 
Position(Radio 

Ground  Fix) 

Altitude  (Radar,  Barom.) 
Orient.-  (Magnetic, 
Angles.  Stellar, Horizon, 
Sun  etc.) 


Fit. 1  Inputs  tnd  outputs  of  nsrlistion  systsus 


Level  3b 


Fil.T  Error  bloolt  diagram  of  ■  Doppler  martial  ayataa  {x-channal) 


Ar  (t)  [rrvUec.] 


Flg.l  Velocity  arror  due  to  fixad  (yro  drift  (ayaO.  l°/h)  for  dlff*rant  ayataa* 

1.  Pur*  lntrtUl  ayataa  (K1  =  0;  K,  *  0;  X,  a  0) 

2.  Dopplar  damped  Inertial  ayataa  (Kl  =0.801,;  K,  =  0;  K,  =  0) 

3.  Dopplar  Inartlal  ayataa  (K1  =  0.  flai,;  K,  =  0.236;  K3  -  0) 

4.  Dopplar  Inartlal  ayaton  with  an  additional  integrator  (KjaO.Oa),; 

K,  «  0.238;  K,  a  0. 2212a>,)  _ 


Correction*  ot 
the  Frror  Model 


F1(.0  Block  dla*raa  of  in  inertial  eyiten  rith  optioun  filter 


CHAPTER  19  -  APPLICATION  OP  KALMAN  FILTERING  TECHNIQUES 
TO  STRAPDOWN  SYSTEM  INITIAL  ALIONMENT 
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CHAPTER  IS  -  APPLICATION  OF  KALMAN  FILTERING  TECHNIQUES 
TO  STRAPOOIN  SYSTEM  INITIAL  ALIQNMENT 


Karls  1. Crocker  And  Leonard  Rabine 


I.  INTRODUCTION 

Initial  Attitude  alignment  of  iritoi  Involving  Inert i»l  Instruments  li  a  requirement  oeueed  by  the  ftct  that 
■enaore  commonly  ueed  In  lnertlel  guldanoa,  navigation,  or  Attitude  reference  eyeteme  metsure  tngultr  rates  or 
lntegrele  of  angular  retea  (gyro  outputs),  or  linear  acceleration  or  Integrals  of  linear  aeon leret lone  (aooelero- 
mster  output!),  When  the  need  axlete  for  ooutlnuoue  knowledge  of  abaolutt  angular  orientation  of  the  frame  or 
platfore  to  ehioh  the  sensors  are  mounted,  then  (Just  as  initial  values  for  intesrale)  the  Initial  attitude  mutt 
be  estsbllehed.  This  le  the  allfnaent  problem  whioh  It  considered  in  thie  chapter*.  '■•>*  baelo  objeotlve  la  the 
lnveetigetlon  of  digital  methods  for  the  deterslnntlon  of  the  Initial  allgnmant  of  a  .rapdown  Inertial  navigation 
syetam  froa  vibration  and  a«ay  corrupted  data  on  the  launoh  pad. 

The  Inertial  components  say  be  sounted  ou  a  atablllaed  platform  or  dlraotly  utruppad  down  to  mu  uncontrolled 
staying  body.  In  either  out  the  essential  aathematiei  of  eetahllehins  alignaent  from  outpute  of  the  inertial 
eosponente  thamselves  la  Identical,  In  a  itrapdown  inertial  system,  the  meeauresents  are  made  In  the  vehicle  or 
body  coordinate  lyetem.  Angular  information  obtained  from  three  single-axi*  platforms  or  three  pulse-torqued 
tyros  le  used  to  update  a  coordinate  transformation  matrix  relating  a  get  of  analytical  or  oonputlnt  axes  to  tha 
body  axti.  This  'coordinate  transformation  matrix  la.then  uaed  to  transform  the  accelerometer  outputs  from  the 
body  axes  to  ths  computing  axea,  The  initial  alignaent  probles  le  concirneri  eith  determining  the  proper  Initial 
valuta  for  the  element!  of  this  coordinate  transformation  matrix. 

If  the  initial  ooaputlng  axes  are  earth-fixed  at  the  launoh  site,  tha  problem  is  reduced  to  one  of  dotermlnlns 
the  . orientation  of  tbeee  use  with  reaped  to  local  vertical  and  an  aalauth  reference. 

The  isimuth  angle  oen  be  determined  froa  nn  optiosl  aaeeuraaent,  ns  shown  In  Referonoe  1.  Ths  detsrslnmtlon  of 
virtual  involvsa  using  tha  aooeleromatar  outpute  whioh  have  been  resolved  throuih  the  coordinate  transformation 
matrix  Into  a  refarenae  coordinate  eyetea.  Thie  syetam  la  maintained  nominally  earth-fixed  at  ths  launch  mite  by 
ualHR  the  syro  outputs  to  compensate  tor  rotations  caused  by  vehicle  tvey.  This  referenoe  eyotea  will  deviate  from 
u  earth-fixed  syetam  due  to  gyro  drift  beaauas  proper  coape nest Ion  for  the  earth’s  rata  cannot  be  provided  until 
the  orientation  of  the.  rsfsrenos  syatea  elth  rsepeot  to  ths  earth  le  blown. 

It  vehicle  motions  ars  sera,  the  determination  Of  the  orientation  of  tbs  rsfsrtnoe  eyetea  with  respect  to  vertical 
le  trivial  aloes  the  eooeleroaetar  outpute  in  the  referonoe  system  are  a  » lapis  function  of  the  orientation  and 
the  acceleration  of  gravity,  whan  there  la  vehicle  motion,  the  output  of  the  accelerometer*  due  to  gravity  must 
be  separated  from  tha  output  due  to  vehlolt  aotlon  by  filtering. 

Filtering  methods  Investigated  under  tbls  otudy  were  all  baaed  on  the  criterion  of  a  mlnlaua  mean  square  error 
end  differ  mainly  in  the  nschanlxetUn  teohnlque  end  tbe  amount  of  a  priori  knowledge  of  the  etetlstloe  whioh  le 
assumed.  A  prim*  effort  of  tbs  study  U  to  Invaitiiat*  the  accuracy  of  a  Kalman  flltur  In  which  both  the  etet* 
equations  end  noise  are  modeled  differently  froa  ths  "true"  characteristics.  A  useful  filter  must  exhibit  little 
sensitivity  to  thee*  aodellng  error*  since  ths  "true"  oharaoteriitioa,  particularly  the  noise  eouroes,  ere  never 
blown. 

Methods  oonaldsrsd  included  an  optimal  filter  of  the  Kalman  type,  a  simplified  Kalman  filter  in  whioh  the  effeote 
of  syro  drift  and  improper  earth's  rats  a ceps  tuition  wsrs  nsslsctid,  a  saxiaum  likelihood  epproaob,  and  a  least- 
squares  ourve  fit  technique  with  and  without  preconditioning  of  the  datn.  Thie  chapter  will  emphasis*  the  result* 
sod  analysis  of  the  Kalman  filter,  line*  the  reoomaendad  approach  waa  use  of  the  simplified  Kalman  filter.  Tbe 
detail*  of  the  analysis  of  tbe  other  technique*  oan  he  found  in  Reference  3. 


I.  ANALYSIS 

1.1  Coordinate  Kyats*  Definition 

Ailinaant  of  a  coordinate  system  defining  a  strapdovn  or  platform  system  implies  knowledge  of  e  btelc  referenoe 
eyates  relative  to  which  the  alignment  1*  performed.  The  reference  system  used  here  le  earth  fixed,  with  one  axle 
along  tha  looml  vertical  oorraspondlng  to  the  average  position  of  tho  tiaylug  etrepdown  system.  Ona  horizontal 
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axla  'll  mimed  in  arbitrary  atlmuth,  This  coordinate  system  li  delimited  CB(0).  The  etripdown  reference 
analytic  system  li  csfl)  ind  li  the  coordinate  system  In  which  ill  nwiHurenittiite  by  the  etripdown  inatrument 
system  cs(2)  ire  referred,  Aiignmunt  eetabllihci  the  rolaUonehlp  between  CS(0)  and  cs(l).  The  etripdown 
■yaten  computer  further  contains  Information  expressing  the  relation  between  CS(1 >  and  CS(3).  In  the  following 
•nilyiie  C8(i)  can  bo  considered  to  coincide  with  C6(2)  initially, 

At  the  initial  tine  CS(1)  it  mleallcned  from  CS(0)  by  the  email  angle  (a,/3,»  s(,  ai  ihown  in  Figure  1, 

hhlle  cs(0)  rotate!  exactly  at  the  earth’ ■  rotational  ritei,  CS(1)  cannot  be  correctly  “torqued"  since  the 
alkallgnment  ingles  a ,  0  ,  y  are  not  known,  Thli  causes  theee  angles  to  vary  with  time  due  to  “earth'  a  rate 
ooupllni",  The  angles,  additionally,  change  due  to  error  drift  rate  of  the  gyros, 

Slnoe  xc  in  defined  as  locally  vertical,  a  neaeunment  of  aoceliration,  A,*  along  axes  mt  and  y,  li 
proportional  to  the  aiaallgnment  angles;  thus, 


*3 

(i) 

*y  . 

(2) 

In  the  strapdown  system,  thi  aouelerstlon  sensing  Instruments  are  aatually  looated  along  axes  of  CS(2)  (or  some 
other  axes  whose  ralationahip  to  CS(2)  is  known  by  physical  alignment),  but  the  meaiureaente  are  transformed  Into 
CS(1)  in  the  strapdown  computer.  The  acceleration  measured  includes  the  effect  of  random  horlxontal  accelerations 
oatiaed  by  the  siliille  away,  This  is  the  principal  noise  input  to  which  the  filtering  methods  are  applied, 


2. 1  Direction  (toslnn  Relatione  Between  Rotating  Coordinate  lystsms 

Certain  basic  direction  cosine  gatrix  equations  are  of  importance  in  undtritandlni  ralatlonship*  betwein 
rotating  oocrdinati  gyatsaa,  hat  ‘C,  denote  tha  direction  online  matrix  which  transforms  components  (V1Jt, V,y, Vtl) 
of  a  vector  V  in  coordinate  system  2  to  its  components  in  coordinate  eye tern  1.  Then, 


‘cs  V, 


or,  in  detail, 


r'a 


(31) 


<Sb> 


Tha  Individual  acoponsnts  of  the  lC,  matrix  danota  tha  ooalna  of  the  angle  between  tha  two  subacrlpted  axes. 

hat  coordinate  system  1  be  fixed  in  inertial  space  while  lyetsa  2  rotates  at  a  rata  cj,  ,  where  the  angular 
rotation  rata  la  measured  or  given  as  components  along  the  axes  of  coordinate  system  3.  Than* 


d  lC 


dt 


t  . 


‘c, ", 


(4) 


where  u.  la  tha  ekew-symaetrlo  aetrlx 


0 


a,  % 
.  0 


<») 


Finally,  let  coordinate  ayetem  0  bs  considered  inertial,  with  ayataaa  1  and  2  both  rotating  relative  to  tha 
Inertial  system.  Than,  to  establish  tha  relation  betwsan  ayatesa  l  and  2,  we  note  from  Equation  (4) 


d#ci 

3 

«C,  <u, 

dt 

and 

d  °c, 
dt 

a 

°cs".  • 

Since 

°c, 

s 

°Cl  ‘C.  . 

it  follota  that 

0  *c, 

dt 

= 

,‘cs", 

*c 

i 


(«) 


•  Matrix  fiithocti  for  £igin««ring  by  U.A.Pipas,  Prentlos-HeU ,  1983,  p.  187. 
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The  equations  dtserlblng  tha  etrepdown  fraction  process  art  darived  in  thif  notion.  Than  inoluda  th« 
differential  aquationa  lovarnina  tha  analac  describing  tha  misalignment  batwaen  the  earth-fixed  launch-nite 
ooordinata  system  (CS)  and  tha  atrapdown  inertial  reference  CS,  the  transformed  accaleroraetor  outputa,  and  the 
■lialla  away  valoolty.  Tha  differential  equations  are  than  oonvarted  to  a  set  of  firet-order  difference 
aquationa,  tlnoe  this  la  tha  fora  appropriate  for  the  application  of  tha  discrete-tine  Hainan  filter  aquations. 
Certain  assumption!  nadt  in  this  analysis  are  a*  follows.' 

(1)  The  initial  ■ieallfMient  angles  are  snail  enough  ao  that  the  small  angle  approximations 
(eln  6  =  6,  cos  9  -  1)  are  valid. 

(11)  Inertial  component  sensing  axes  are  orthogonal  to  each  other. 

(ill)  The  gyro  drift  rates  are  constant. 

(lv)  Oyro  torqulng  errors  and  accelerometer  instrument  errors  are  small  and  not  considered. 

(v)  The  sway  velocity  is  sdaquately  represented  by  a  narrow-band  noise  prooeas  having  zero  naan  value. 


3. 3.t  T rmafornad  Aece {frowsier  Outputs 


The  inertial  Instruments  which  measure  linear  acoeloration  are  Integrating  devices,  so  that  thalr  outputs  are 
proportional  to  the  Integral  of  acceleration  over  fixed  tine  intervale.  In  partloular,  the  outputs  along  y,  and 
xt  axsa  are  given  by 


*  f*‘  g/3 <r)  dr  +  V,^)  -V,(t..,) 

*l-i 


(7) 


f*l 

Pe<ti>  ”  L  -»y(r)  dr  +  V,(tj)  -  Vjftj.,)  , 

*l-i 


there 


P,(t)  ie'the  output  along  ak  at  time  t 
P,(t)  ie  the  output  along  y,  at  time'  t 
VJt)  la  tha  sway  valoolty  along  sk 
V,(t)  la  tha  away  valoolty  along  y( 
and  g  le  tha  valua  of  gravity  (•/mo1)  . 


(8) 


Tha  horlxontal  accelerations  caused  by  min  lit  away  art  assn  to  be  Included  in  the  system  measurement  e,  While 
tha  missile  sway  causes  tpurloue  accelerations  (nolle)  to  be  Miaursd,  the  twiy  ie  limited  to  finite  valuee  whole 
everego  taoeleretion  is  aero.  This  allows  tha  noiaa  to  ba  aodalad  at  a  zero  mean  prooeas,  In  certain  praotioal 
situations  (ships,  airplanes)  in  which  the  net  average  motion  la  not  aero,  additional  inputs  ara  requlrtd  to 
deaorlba  the  motion, 


2.3.3  Bjuat (one  Governing  the  Angles  a,  /},  y  Deeerihirtg  the  Alignment  Between 
the  Barth-fixed  Launch-Sit e  Coordinate  Syita •  and  the  Strapdom 
Rafaranca  Coordinate  System 

Tha  thraa  ooordinata  syatsms  of  oonoarn  in  this  analysis  art 

Gi(O)  -  Earth-fixed  launch-site  CS 
CS(1)  -  Strapdown  raferanoe  CS 
CB(9)  -  Strapdown  inatruuent  CS. 


The  transformation  aquation  solved  by  the  atrepdoen  ooaputlng  aye tea  relataa  cs(3)  to  CS(1).  This  equation 
follows  from  Equation  (6),  - 


*C,  «,  -  <o,  >C,  , 


(») 


share  u,  la  tha  matrix  of  angular  rates  measured  by  the  gyros, 
it  the  attrlx  of  earth*  e  rate  in  CS(0). 


In  Equation  (0),  the  vnlue  of  earth* e  rate  in  CS(0)  ie  used  rather  than  the  proper  values  corresponding  to  the 
rate  in  CS(1),  elnct  there  is  ea  yet  no  intonation  relating  the  alignment  of  CS(1)  to  CS(0). 


The  gyro  measured  rites  are  in  error  by  the  gyro  drifts.  Thus 


'.*  .-VW-Vl 

U'  a'*,  i~*\v.hv  .'*  .1 
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whir*  6  represents  tha  true  angular  rataa  of  tha  swaying  body  tnd  d,  repreaents  the  gyro  drift  ratn*  In  the 
Instrument  uu. 


Tha  lnvaraa  t auction  to  Equation  (9)  ia 


*c  i  ut  'ci  • 


Subaltuting  for  the  neaaured  rata  u}  from  Equation  (10), 

d  *0,  .  . 


In  the  iaiM  manner  aa  for  Equation  (0), 


s  'Cj  oj0  -8  *C,  -  d,  *C, 


"C,  i-M,  °C1 


and,  with 


SC,  »  40,  *0t  , 


**  find,  uiing  Equation*  (13)  and  (13)  that 

d  4C,  „  .  .  , 

~  «  8°i>°°.  d,  '°i  • 

Thi*  la  tha  baale  aquation  vhioh  ralataa  tha  alrapdown  rafaranoo  cs(l)  to  tha  earth- find  gyatam  CS(0), 
Tha  aquation  )a  alopliflad  by  flrat  noting  that  tha  drift  tarm  oan  ba  written  aa 

«C,  d,  »c,  a  »0,  *0,  d,  *0,  .  «C,  d,  . 

Coaponanta  of  tha  drift  will  ba  aaauaad  conatant  In  C8(l)  rathar  than  CS(3). 

Since  cs (1 )  differs  fraa  Cfi(0)  by  aaall  anglsa,  aa  shown  In  Figure  1,  °Cl  oan  ba  arlttan  aa 

‘l  -y  0 

*0,  a  y  ,1  -Ct  , 

■-0O.  1 

Substituting  Equation  (lb)  In  Equation  (14)  than  oauaaa  Equation  (14)  to  aiaplify  to 


"be  “Vo 


H-K 


dy 

dt  "“V*  “»* 


Tha  aquation  for  tha  full  utria  d  °C  ,/dt  reduce*  to  only  three  aquations,  alnoa  tba  angles  a,  0 ,  y  are 
aaall.  Tha  u,  matrix  contain*  the  value*  of  earth's  rata  in  CS(0),  and  tha  unknown  drift*  appear  in  tha  d 
aatrlx.  Filtering  sill  produo*  astiaatas  for  both  tha  aisullunaant  angle*  and  tb*  drifts. 

2 .3,3  Equation  a  Dttcribing  the  Noit*  fnputi  to  the  Syit««  Velocity  Keoeu  raaetit# 

Tha  valoolty  aquations  (7)  and  (8)  lndioata  tha  presence  of  noise  tares.  This  noli*  is  predominantly  obuaad 
by  slaalla  asay,  Tba  nolaa  cannot  b*  represented  aa  whits,  but  rathar  a  correlated  valoolty  noli*  modal  la  a 
batter  representation,  dua  to  the  dynaaic*  of  tha  missile  sway.  Tha  correlation  function  to  b*  used  la 

{£>)  s  ar‘  i  "I  ^ /V  ooa  ,  (II) 

To  generate  this  random  variable  froa  shit*  no!**  inputs,  1st" 


v,(t)  w  .  n,(t)  ooa  a^t  a  n,(t)  ein  o>at  . 
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thtrt  n,(t)  tnd  n,(t)  irt  lndtptndant  rando*  varlablta  witti  th«  autoeorralation  funotlon 


«.,W 

a  8,  (0)  a  o\  fUl/f  . 

(30) 

No In  with  thla  autooorrilatlon  funotlon  oan  bt  oonaldtrtd  an  btlni  tht  tolutlon  to  tht  atoohaitlo  difftrintlal 
tquatlona 

b,(t) 

1  (-lA)n,(t)  +  wt(t) 

(21) 

4,(t) 

■  (-lA)a,(t>  +  »,{t)  . 

(33) 

thtrt  *j(t)  and  w,(t)  art  whltt  nolta  random  rarlabWc  with  autocorrtlatlon  funotlon 

IfCyt,)*^,)] 

=  *[wf(tl)w,(tl)l  a  — — !  8 (t t - tf)  | 

(23) 

8(t,-tt)  la  tht  Dlrao  dtlta  funotlon, 

»,<t)  la  tht  atay  valoolty  along  tht  a 
a  la  liar  tquatlona: 

axla,  for  tht  away  vtloolty  along  tht  y  axla,  v,(t)  , 

i  wt  havt 

*,<t>  « 

n,(t)  oot  a^t  +  n,(t)  alno^t 

(24) 

d,(t)  - 

(-lA)n,(t)  ♦  *3(t) 

(2B> 

A,(t)  ■ 

(-l/r)a«(t)  +  w„(t)  ,  > 

(30) 

whtra 

2n* 

*  l[»»<t,)wH(t,)]  ■  -JE  5(tt -t,)  . 

lC*,(ti)w,(t,)] 

(37) 

3.3.  i  Convert  ion  of  tht  Syittm  Iquat  iont  to  tho  Kalnan  Stott  tquntion  Fora 

Tht  tyttti  tquatlona  art  daaorlbtd  by  Equation*  (T),  (8),  (17)1  (18),  (31),  (23),  (24),  (30)  and  (28),  Thai* 
will  b«  ohanatd  to  a  dlfftranoa  or  atati  aquatloh  (ora  dlrtotly  rtooanlnabla  a*  tht  ooaton  fora  for  application 
of  thi  Kalaan  .fllttr  tquatlona.  Tht  prootta  la  fairly  dlrtet  thoUih  ttdloua  and  intaratdlata  rtaulta  till  not  b» 
ahotn*.  All  tht  difftryntlal  tquatlona  In  th«  att  art  1 Intar:  thty  art  of  tht  fora 


—  ■  r*(t)  +  oi(t>  (38) 


and  havt  tht  gtnaral  tolutlon 

*<»t> 


^<tl*tl-|),<tl‘i)  +  r  1  d>a.,r)w(r)  dr 
*l-i 


(80) 


thloh  la  of  tht  proptr  atatt  aquation  fora.  In  Equation  (20)  tht  itata  tranaltlon  aatrlx  It  tht  aatrlx  aaponantlal 


Tht  full  ttatt  aquation  it  finally  obtained  in  tht  following  fora: 


«(tt) 

’  «(tt.,)’ 

/8<tt> 

*  li  *11  0  0 

0 

r<*i> 

' 

r<W 

W 

d,<tj.,> 

w 

0  I.  0  0 

VW 

0 

w 

»,(t4) 

♦ 

p,(tt) 

*J1  *Jt  1  *J* 

C(t) 

*.<*!> 

•»<*!-.> 

»,<*1> 

n,(t,) 

0  «  '  0-  *„ 

«,(»!•:) 

I 

».<»!> 

W' 

u,(ti) 

U,(ti) 

U,(tt) 


(31) 


•  Mr  a  dttalltd  tftrivatloa  ui  Mftrtcct  1. 


(32a) 
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*u  ■  1 - iH  a** - 

<a  ■  (w.1  +  ol*  +  oj.1) 

*0  'o  "o 

oifl  is  ths  <u  *itrit  of  Bqumtion  (17) 

J  is  tbs  3  x3  unit  BAtrii, 

*  mt -w  +  Ll^izhiA  .  fltiin s  - 

o)1  L  J 


*i.  *  - 


O  |  0 


0  0-| 


fc„  ,  f°  '  °1  f .  t^LLW*  t ,  A-*f.  8i"<*i:*i.A  . 
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-  0<»i)  -  ottj.,) 


1  In  th«  4x4  unit  watrii 


C(t)  * 


cat  c^t  Bin  o^t  o  o 

0  0  cob  c^t  I  in  «#t 


Th*  nait«  tin  which  iruu  in  tb*  at*t#  •quit loot  ar*  related  to  th«  whit#  noli*  of  Equation*  (21)  to  (28) 


"i<V  ftt  -i'" 

u,(tt)  "  V,*“(tl‘T>  *«(r>  ^ 


and  have  th»  variance 


fc«)  ■  l(uu')  *  cj(l  -  #',(,i*ti’‘1/T)  j  . 


Tha  dat'i  aaaauraMnt  oonainta  of  tha  two  tnniforaad  aooalaroaetar  output*.  Thar*  la  additional  nola*  of  th* 
Maauraaant  du*  to  quantization  of  tha  aaowUroaiLar  outnuti.  ’tha  aaaaurMant  aquation  la  pivan  by 


r( tt)  «  H(t|)X(tt)  +  r(t,>  .  (41) 

’ 0000  0  0  I  0000  o' 

whar*  N(tj)  »  (48) 

[0  0000001000  0 

r(t|)  la  th*  ooia*  dua  to  quant iaat loo.  It*  covariance  matrix  if  *iv*n  by 

»<tt)  .  rtrttjlr'd,)]  «  ~  [j  jj  .  (43) 

wh*r*  A  In  th*  quaatiiatlon  latal. 

9han  a  thaodollt*  a*A»ure**nt  in  takan  and  prccaaaad,  tha  raauitina  quantity  la  tb*  aiiautb  alaallanaant  plua 
an  error  which  la  equal  to  tha  lavallaa  error  about  th*  projection  of  tha  LOB  In  the  boriaonul  plan*  nultlplied 
hr  th*  uanaant  of  the  elevation  anal*-  Thua,  whan  a  thaodollt*  aeaauraaant  la  takan,  th*  H(tt)  aatrix  la 

Hitp  «  (l,  tan  ya  aln  {  ,  tar  7,  co*  t,  0,0,0  0,0,0,0,0,01  > 
whar*  t  la  tho  anal*  b*t***n  the  protection  of  th*  US  in  th*  horizontal  plan*  *Dd  th*  *.  ail*. 


(44) 


3.  OPTIMAL  FILTER  EQUATIONS 


r.j 


« 

& 


f; 


O! 

I'- 

*-S 


400 


In  Motion  3,  tht  ayitaw  equations  were  dsrlvsd.  Thor  in  r« pasted  hiro  for  oonviniins*. 

«(tt)  •  +  a<tt>  u(t,>  (48) 

y(tj)  *  H(tj)  *<t4)  ♦  r(tj)  .  (48) 

The  Mil-known  Hainan  filter  Equations  own  be  spoiled  to  system  with  this  description,  These  equstlons  live 
*n  estlnste  of  the  state  vsotor  x(t4).  blind  on  the  eessurtMnts  {y(tt)  ...  y <t4 )}  ,  which  Is  optimal  In  the 
■ssn-sautre  sens*.  The  filter  Is  described  by  tbs  followini  dtfferenoe  equations: 

*<tt,tj.t)  *  </>ft1,tl_l>ftCt1_1»  (47) 

*(t,)  «  Sttj.tj.^  +  K<t1)[yft1)  -  Mtt1)S<t1.t1.1>]  .  (48) 

The  optlnsl  filter  gains  K(t^)  are  calculated  froa  tho  followini  set  of  difference  equations: 

Nti.tj.,)  «  <*(il.t1.l)r<t1.1w><t1,t1.l)  +  a<t1)Q(ti)a,(t1>  <4t) 

K(tj)  *  +  Rftj)]’1  (80) 

P(tj)  =  [I  -  Kft1)H<t1)]  Ktj.tj.,)  .  (81) 

where  t(t4)  is  the  optlnsl  estlssts  of  x<t4)  ,  given  the  Misurinsnts  y(tt),  y(t,),  ...  y(t4) 

^(tj.ti.j)  is  the  optlnsl  estlssts  of  *(tt)  .  given  tho  Mskurensnts  {y(t1),y(t|),...y(tlat)} 

P(tj)  is  the  oovsrlsnos  nstrlx  of  the  error  in  the  estlaste  S(t1)  , 

P(tj,ti.t)  is  the  oovsrlsnos  nstrlx  of  the  error  in  the  estlaste  i(t4. t,.t)  . 


These  equstlons  describe  the  optlnsl  filter,  it  Is  desirable,  however,  to  slnpllfy  and  decouple  the  equations 
to  reduce  the  aonputst lonsl  reqtiirenents,  Tht  perfornsnoe  of  the  optlnsl  filter  is  described  In  Motion  8.  It 
Is  slso  demonstrated  that  the  degradation  caused  by  certain  sinpHflustlons  Is  negligible. 

These  simplifications  will  be  Investigated  in  the  following  section. 

«.  IUBOPTINAL  FILTER  EQUATION! 

4. 1  Introduction 

The  filter  aquations  presented  In  the  previous  section  are  rather  coaplex.  They  Involve  13  simultaneous 
difference  equations  and  henot  multiplication  of  13*13  sstrloss.  It  is  dsslrible,  than,  to  invsstlfsts  tbs 
possibility  of  slwpllfylug  thus  equations.  In  ordar  to  dstsrelns  If  tha  slnptif  lost  Ions  are  acceptable,  one 
suet  calculate  the  dtfradstlon  in  filter  perforeance  caused  by  then,  In  addition,  the  sensitivity  of  ths 
filter  to  errors  in  the  noise  should  be  lnvestiisted.  Ths  aquations  required  to  evaluate  the  suboptlmel  filter 
performance  are  derived  In  this  section.  The  approximations  to  ths  lystsm  dynamics  which  are  used  In  ths 
suboptlasl  filter  are  also  presented. 

The  auboptleel  filter  le  obtained  by  simpllfyin*  the  state  aquation  auob  that  tbs  stats  transition  matrix 
^(tj.ti.,)  of  Equation  (48)  Is  raplaesd  by  sa  spproxlaats  end  alapler  fora  ^(tj.tj.,)  . 


A  fairly  general  aodsl  for  tbs  suboptleal  filter  aqustloj*  la  than  given  by 

*,(t|.tj.,>  »*,(*|.  *1., >*,(»!., )  •  ‘  <»« 

»,(t,)  »  Wti-,)  +  K.(t1)[y(t1)  -  H(tl)x,(tl.t1.l)]  .  (88) 

Tha  subscript  e  denotes  aubnptlnal  quantities.  The  gain  lfg(tj)  le  obtained  from 

%<*l,*l.l)  *  +  WW0'**!*  <«> 

E,(t,)  »  Fi(t1.t1.l)H'<tl)[H(t1)F,(t1,t,.,)H'(tl)  +  Rltj)]*1  (88) 

*.<*!>  a  [I  -  «,(t1)H(t1)]P,(tt.t,.l)  .  (88) 


These  equations  tre  Identical  with  the  usual  Eslasn  sat  sscapt  that  they  Involve  suboptlasl  quantitive,  To 
determine  tbs  trut  cover lsnci  oatrlx  of  ths  sstlasts  errors,  as  first  define  ths  qusntltiss 
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1  ■  •  fc  *  *  <  ■  ‘e'V  v' 

.•  V  V  Vo*  H 


•Vtj)  «  e[i(t1)i'(t1)] 

?,<»!)  ■  lUB<t1)l'(tl>] 

%(tt>  «  t)]  . 

Tba  oovarlanca  aatrln  of  citlaat*  trrora  (or  thi  auboptlBtl  (Uttr  li  »ivan  by 

Htj)  *  (UiU()  -  -  2l(t1>] '}  .  (81) 

Equation  (87)  nan  b«  *rltt«n,  In  taraa  of  th»  uovnrltnn*  aatrlo**  defined  ibovi , 

Tft,)  <=  P^tj)  -  P'(t[)  -  Pjftj)  +  P,(t,)  .  (88) 

By  wiltlplyini  Equation  (18)  by  it*  tranipo**  and  taklni  upeetid  valuta  of  both  aidaa,  on*  laatdlataly 
obtain* 

P,(ttl  ■  +  a(ti>«(ti)0'(ti>  .  (88) 

Multiplying  equation  (83)  by  tbt  tranapoaa  of  Equation  MS)  and  taklni  anpaotad  taluia  ylalda 

Wj.j)  .  (*o> 

Tbt  aquation  (or  l»|(tl>  la  obtalntd  by  aultltlylm  equation  (S3)  by  x'(tt)  ,  It  la  (Ivan  by 

P,( tt)  -  (I  -  *iH(t,)]P,(tl,ti.i)  +  Mtt^Pjdj)  .  (Oil 

Multiply ln«  Equation  (83)  by  ita  tranapoaa  and  taklni  anpaotad  valuaa  glvaa 

P.dftj.,)  »  <^.<t1.ti.1)l»J(fc1.lV^'<ti,fc1.1)  .  (83) 

Thi  aquation  (or  P,(tj)  la  obtaluad  by  aulttplylng  equation  (81)  by  ita  tranapoaa  and  taklni  anpaotad 
valuaa,  Attar  aoaa  algebraic  Manipulation,  oaa  obtain* 

p,(tt)  ■  r*<ti,tl.i>  +  «,<t1jM(t1)[p;(t1)  -  lytptt.,)]  + 

+  CP,(ti)  -«',<t1.t1.,)]H'(t1>k'<t,)  + 

+  ia(ti>H(t|)[pl(ti,t|.1)  -  r1(t1)lHl(tt)K;(t1>  + 

+  ei(t1)«(t1>e'(tl)  ,  (ss) 

Thi*  ooapl*t**  th*  d*riv*tlon  of  tba  aquation*  naoanary  to  ooaputa  tbt  eovarlanoa  aatrlx  of  aatlaatlon 
trrora, 

4.1  Aparontaatloaa  to  Myataa  Oynaalo* 

U  aarth’i  rotation  rat*  1*  nailaotad  («  *  0),  tba  ayataa  dynasloa  art  oonaidarably  alapllflad. 

Tba  atata  tranaltlon  ■atria  baooaaa 
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Tba  raault  of  thla  alaplKloatlon  la  that  tba  aquation*  (or  a  ,  p  ,  and  y  b*coa*  unoouplad.  If  th*  drift* 
*r*  milaotad.  a  furtlur  nlspllf loation  raault*.  Tha  aquation*  dtaorlbln*  0  ar*  |l««n  by 
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Thi  aquationa  duorlblng  y(t,)  art  of  -almoat  tha  idantloal  form  with  a  aim  diffaranoa. 


Tha  aquation  for  a  ia  ulaply 
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Tha  filtar  oorraapondlni  to  thaaa  uncoupled  dynaBlaa  ia  alao  uncoupled.  A  aummary  of  tha  auboptiaal  four* 
•tat*  filtar  aquationa  followa, 

*  0*(t4. tA_  1>*r<t1.l) 

ai(t1l  a  +  ^(tjUp^tj)  -  H*(tl)il(tl,tl.,)i 

t, (tj >  «  I.Uj.tj.,)  + 

<tt>  ♦  »*<t4»]“l 

F*(t()  a  [1  -  . 
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A, 3  llaa  Irrora  in  tha  auboptiaal  Filtar 

Tha  approalaatlona  to  tha  ayatai  dynaaioa  oan  oauaa  a  blaa  to  appaa r  in  tha  auboptiaal  aatiaata,  and  no  dlraot 
aathod  haa  yat  appoarud  to  dataralna  thia  blaa  aa  raadlly  aa  tha  detwraination  of  tha  aovarianca  aatiaata  of  tha 
auboptiaal  arrora  ilvan  by  Equation  (SO).  In  aaoaral,  a  blu  will  occur  if  tha  non-nolaa  aaaoolatad  part  of  tha 
dynaaio  aquationa  ia  appmiaatad,  or  If  tha  aaaauraaant  aquationa  ara  chantud. 
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tn  thi  i  implif  loot  ions  diacuaieri  In  Suction  4.2,  the  variation  in  tine  of  the  angle*  a  ,  [i  ,  y  caused  by  the 
earth'*  oroas-aoupling  is  noglectud,  Thia  causes  a  bias  to  ooour  in  the  estimates  made  by  the  simplified  filter. 

An  approximate  expression  for  ths  bias  oan  be  calculated  by  neglecting  sway  noise.  In  this  case,  the  angle  la 
varying  essentially  as  a  linear  function  of  time  due  to  earth's  rate  orosa -couplings.  Hoeevar,  the  filter  neglects 
tlae  variation  of  the  angle  and  assumes  the  angle  to  be  a  constant.  It  oan  bo  shown  that  the  error  in  the  estimate 
which  minimizes  ths  mean-square  error  is  equal  to  one-half  the  change  in  angle  over  the  measurement  time.  This 
fact  can  be  used  to  write  expressions  for  the  measured  angles  in  terms  of  earth’s  rate,  the  gcoaotry  of  the 
optical  measurement  of  azimuth  and  the  actual  angles.  Then  equations  can  bs  solved  to  yield  a  better  estimate 
of  the  aotual  angles.  Details  ar*  shown  in  Reference  2, 


5.  RESULTS  SUMMARY 

figures  2  through  9  show  the  results  of  the  analysis  of  the  Kalman  filter.  These  results  are  obtained  from 
oowputer  simulation  of  tho  appropriate  equations.  Figure  2  is  the  ler  ereotlon  error  for  the  optimal  12-etate 
filter.  This  filter  is  described  by  Equations  (47)-(Bl).  The  conditions  used  for  this  baseline  case  aro  given  by 

Initial  integrated  velocity  uncertainty  crp  *  o 

Initial  erection  uncertainty  a  1/2  degree 

dyro  drift  uncertainty  erd  e  o.l  mtru  (1  meru  a  0.015°/hr) 

R.M.  B.  away  veioolty  cry  «  o.B  ■/■ 

Aootleromater  quantisation  level  A  *  0.02  a/e 

Center  frequency  of  away  velocity  power  spectrum  f0  ■  0,28  Ha 

Correlation  time  (reciprocal  of  bandwidth) 
of  away  velocity  power  gpeotrun  r  -200  a 

templing  rate  1  eample/i  . 

Figure  3  showi  the  performance  of  the  euboptlmal  4-itate  filter  for  varloua  initial  erection  angles.  This 
filter  le  described  by  Kquetiona  (971-03).  The  gain  simplification  employed  in  reducing  the  12-utate  optimal 
filter  to  two  identical  4-stste  filter*  was  ths  neglect  of  garth's  rata  oroae-coupling  tarma  in  the  system 
dynamics  used  in  the  filter  equations.  In  addition,  gyro  drifts  were  neglected  in  the  simplified  dynnmlas,  The 
difference  in  errors  for  varloua  initial  anglaa  la  attributable  to  th*  earth's  rate  coupling.  For  initial  angles 
leas  than  O.B  dagrasm  the  increase  in  error  over  the  optimal  filter  la  laas  than  1  second  of  aro  at  60  aaconds 

tint.  If  the  initial  angle  uncertainty  1*  large,  the  12-stats  optiaal  filter  performance  oan  be  epproeohed  by 

updating  th*  computer  coordinate  system  after  about  20  isoonds  to  reduce  the  oroes-ooupllng  affects.  Another 
approach  to  removing  the  oroei-aoupllng  terse  la  to  use  the  corraotlon  matrix  darlvad  in  lafartnc*  2, 

Figure  4  shows  th*  degradation  in  performance  due  to  th*  neglect  of  gyro  drift.  In  Flgur*  4,  th*  gyro  drift 

numbers  shown  as  parameters  ere  tie  1  a  uncertainties  in  tbm  true  gyro  drift.  The  filter  equations  oieuma  aero 

gyro  drift.  It  le  eaen  that  th*  drift  unoertalnty  suit  be  quite  ltrg*  (20  menu  <0.3  deg/hr)  before  th*  filter 
parforguot  le  degraded  appreciably. 

Figure  3  ahowe  th*  ereotlon  error  versus  time  fur  various  campling  tlsea.  A  sampling  time  of  1  etoond  seese 
to  provide  g  cood  trade-off  between  computational  requirement*  and  erection  eoouraoy.  The  worst  cue  occurs  whan 
th*  sampling  time  is  4  eeoonde,  This  le  baoauet  the  center  frequency  of  the  sway  vvlooity  power  spectrum  is  0,25 
herte,  nines  the  power  eneotrum  is  vary  narrow,  th*  sway  velocity  is  almost  sinusoidal,  with  e  period  of  4  aioonds. 
Th*  sampling  la  thus  at  th*  eeae  pert  of  th*  sine  wave,  and  it  becomes  quit*  difficult  to  filter  out  th*  noli*. 

Th*  correlation  time  (reciprocal  of  th*  bandwidth)  of  th*  narrow  band  noli*  hie  e  significant  effect  on  the 
situation  aoouraoy,  Till*  la  demonstrated  in  Figure  B,  where  the  correlation  time  eeeuaed  in  the  filter  equations 
■atobui  the  correlation  tin*  of  th*  actual  noli*,  It  wee  found  that  th*  filter  tu  insensitive  to  error*  in  th* 
uiuagd  correlation  tint.  Whtn  th*  auumed  correlation  time  we*  20  **oond*  rather  than  th*  teu#  o«rr«latlon 
tlae  of  200  aeoonda,  the  degradation  in  filter  performing*  wu  negligible,  The  important  parameter  i*  the  aotual 
not**  oorralation  time  and  not  th*  correlation  time  assumed  fur  th*  filter  oelouletiuni. 

Since  th*  frequency  of  the  nieille  sway  nay  not  be  known  exactly,  it  it  of  interest  to  determine  th*  eeneitivlty 
of  the  filter  to  that  parameter.  Thl*  ie  shown  in  Figure  T.  In  this  ogee,  th*  actual  frequency  is  0.25  hertz, 
eblle  tbe  number  uetd  in  th*  filter  calculations  ie  0,2  hirtz,  It  is  mid  that  the  aocureor  of  the  estimate  la 
■omewhet  poorer,  but  (till  acceptable.  The  performance  for  an  eeeuaed  frequency  of  0.3  harts  is  almost  identical 
to  th*  ourvt  a  hewn  in  Flgur*  7  and,  therefore,  has  not  been  ptnentid. 

Aa  alternative  method  of  ereotlng  th*  analytic  coordinate  system  1*  to  uec  a  leaet-aquerea  filter.  The 
oomputetlonel  requirement!  of  thli  method  ere  auoh  leea  than  those  of  th*  optimal  filtering  technique,  Th*  estimate, 
of  oourso,  tabes  longer  to  converge  to  within  eooeptebls  limit*.  Figure  8  compares  the  performance  of  the  leaet 
iqutree  and  tho  optimal  4-etat*  filter*  of  th*  oaee  when  r  »  poo  e.  The  optimal  filter  le  significantly  better 
than  the  loaat-squnrea  filter  for  thl*  caao.  Figure*  9  end  15  show  th*  same  comparison  for  r  =  20  e  and  s  • 
reepectlV'.'ly,  It  le  seen  that,  as  r  teoreaaea,  the  letat-squaree  filter  performance  approaches  that  of  th* 
optiaal  filter.  This  la  to  be  expected  elbo*.  for  white  noise  (r  n  0).  th*  leaet-iquarea  filter  ie  optimal. 


Thu  prtoeding  curves  were  calouleted  by  determining  tha  covariance  matrices  for  the  entimat lor  errors,  In 
addition,  a  almuiation  of  tho  filter  eauationa  with  incut  noiae  derived  from  a  random  number  lenerator  wen 
performed.  Figure  11  nhowa  the  results  of  one  run  of  tbit  almuiation  with  the  eway  velooity  noise  eptctrum  lying 
In  a  narrow  bund  around  a  oenter  frequency.  The  17  value  obtained  from  tho  covariance  matrix  calculation  ia 
shown  for  comparison.  Figure  13  ahows  the  reeulta  of  a  run  In  whioh  the  input  noiae  ia  assumed  to  consist  of 
three  narrow  band  noises  et  different  center  frequonclwi,  The  filter  still  assumes  that  the  noise  is  centered 
In  a  narrow  band  around  a  alngle  frequency.  The  three -frequency  nolle  ie  considered  to  be  a  more  realistic 
rapresantetion  of  the  volooity  of  a  swaying  missile  with  invorsl  bending  model  on  the  launch  pad.  Tht  center 
frequencite  used  ware  1. S3  red/a,  3.14  rad/a,  and  2.33  rad/a,  with  a  correlation  time  of  300  second*  for  oeoh 
band.  The  total  r.a.a.  away  velocity  was  0.S  m/a. 

Certain  “rulva  of  thumb"  whioh  have  bean  duvaloped  to  allow  extrapolation  of  the  reeulte  given  In  this 
chapter  to  different  noise  character latloe  and  filtering  times  ers  su  follows: 

(a)  The  r.m.e.  filtering  errur  la  proportional  to  tha  r.m.e.  value  of  the  away  velocity  nuise. 

(b)  It  aarth'l  rate  ornss-cioupllnga  are  removed,  by  updating  or  by  uelng  the  correction  matrix,  the  filtering 
errur  ie  not  a  itrong  (unotlon  of  the  initial  angle  error. 

(o)  The  filtering  error  li  approximately  lnvereely  proportional  to  the  nolle  center  frequency. 

<d>  For  ebort  correlation  tinea,  the  filtering  error  for  both  the  optimal  {-state  and  leaat-aquaraa  filter  la 
approximately  lnvereely  propcrtlonel  to  the  three-halvi*  power  of  the  filtering  time  (Error  =>  K/l'*'  *> .  Thle 
li  ihown  by  plotting  the  reeulta  of  rigure  9  on  lug-log  paper  In  Figure  13.  For  longer  correlation  tlmea, 
the  leaet-equaree  filter  has  a  filtering  error  whioh  la  sore  nearly  lnvereely  proportional  to  the  square  of  the 
filtering  tine,  while  the  4-etate  nptimnl  remains  invaraely  proportional  to  the  throe-halves  power  of  the 
filtering  tine.  Thle  ia  shown  by  plotting  tha  reeulta  of  Figure  8  on  log-log  paper  in  Figure  14.  It  must  be 
reambered,  however,  that  the  curves  for  the  two  flltere  can  never  internet,  so  that  the  least-equarue  filter 
error  muet  approach  being  Inversely  proport lonsl  to  the  three-hslves  power  of  filtering  time  eethetlmo  lnuroaeee, 

(1)  Tht  filtering  error  for  the  optimal  {-state  filter  ie  approximately  invaraely  proportional  to  the  equare  root 
of  the  away  velooity  correlation  time  (Error  a  K/r1''’).  The  leeat-iquaree  filter  error  only  approaches  being 
lnveriely  proportional  to  tha  square  root  of  the  oorrsmtlon  time  at  low  correlation  tinea,  however.  For 
higher  correlation  time  the  Improvement  In  performance  with  lnoreaalng  correlation  time  la  muoh  leas  than 
that  of  the  optimal  4-atate  filter.  Thle  li  ihown  by  plotting  the  reeulte  of  riguree  8,  9  end  10  at 
<0  seconds  tine  on  log-log  paper  in  Figure  18.  Thit  rule  obvloumly  cannot  bo  used  as  r  approaches  giro,  but 
It  doae  hold  at  leaet  doen  to  r  •  1  1. 
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satellite  positions  and  tin*  »t  the  1th  Interval 
(round  rsferanoo  oscillator  froquenoy 
stable  frequency  transmitted  from  satellite 
u»r  received  frequency 
frequency  difference  (satellite) 

Doppler  count  for  satellite  Interval  1  ,  J 


tine  st  satellite  Ith  Intel vnl 

Incremental  tine 

slant  rants  at  ieh  interval 

lnoreaental  slant  range  In  1  ,  J  Interval 

speed  of  light 

speed  of  sound  in  eater 

gravity  hsreonio  (1)  and  order  (J) 

frequency  scale  oonstant 

ISO  Wlz  and  400  MHz  frequency  distortions 

sonar  Doppler  bean  transmitting  sngls 

steady  state  attitude  error 

dyutnlo  attitude  srror 

velocity  error 

teapereture  (water) 

salinity 

depth  of  transducer 


etete  variable  vector 


eyetee  dynaaios  aatrix 
stats  noise  vector 
state  transition  aatrla 
aystsa  nols* 

velocity  oonponents  along  l**1  asla 
ooordinats  transforaation  aatrla 
earth  radii 

perturbation  quantities 
ltk  ails  acoeleratlon 


earth  rate 


latitude 


.V-.v V-  \\- 

.v.v.v. w.fr: 

*  a  •*  *  "  .  ‘  .  *  .  *  ' 

\J>y. *  *  *»y 

(4  ijjr  ^  ifl  »V  WVi; 


«■  .  a*.  e\  -  .  Hmt 
»  -  »  -  .  *  .  "  .  *  -  *  s 
w  ♦.  1  .•s'.  . 

“■/-W.V. 


*  a  "  h  *  ••  V*  •  ei  1 

>y 

Le‘“  a“'  /•  -**V*  /•Ag 

L-.V.V. 


'^y-y-y/y-y 

[■yy'^S'-'y 

h  ‘  .  ■ .*  *  q  •  .  ■*  „ 

hr  •  a»tda,.3l4>i-*.i*a,V 

tavOMMMaii 

f*  .  »-  -  *~rr^  t  vVv 

V  •  .'■vA> 
;  y  \  .-N 

■'  1  ;  iv'-'.vy 

I  '  *  1  .  *  e.\n%  t,  «\,V 

y'.v\ 

th»  -i  ,  -  -,4>  r,J  -  »  •  M 

■  'viv-.'/v 
v»: : 
v  y-v.v 

"t*V»  V*®!,  i', ■ 


*  ‘/'r  vY-%v 

,*  \e«>^  /*  *  •  M 


/'■v>  .  V  , 


mtvwvwiei 


4*  --  V  V  V  *a* 

ttW®  HU  *  N**  •«WA 

1 

les*-  W*k  / 

,  a  *  a.  "  a,  •  ’  «  e  * 

1  >-■»**•  v  » 

.  a**1**’*'  •  *  «  ■*  e 

•  ..  ‘  a  *  a  ■  a  »  a  M  a  *  . 
’  .  "  e.  *  s.^*  *  *  *  "  a  ’  .» 

i\<A^\vV*V-V-*V 

v’./.'.’vVw'aV 

•  a  «  fc.  •  -  *  H  A.  *  «  •*. 


"  a  *  •»  *  *  n  **  i  a  «_ 

.'Vv 


h-  “ 


r.  j.  £ 


Subtcript i 


longitude 


gyro  drift 


internal  iyro  ana  lea 
tyro  tin*  constant 
gyro  damping  (aln 

sonar  Doppler  frequency  difference  along  1th  axis 
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A  KALMAN  FILTER  AUGMENTED  MARINE  NAVIGATION  SYSTEM 


H.  Halmaandarli  ind  D.Ozdee 


1.  INTRODUCTION 

With  the  technical  horizon!  expanding  very  rapidly  In  recent  years.  new  demands  have  bean  tnpoaad  on  the 
performance  indloaa  of  marine  navigation  syatema.  Typical  lndioei  ara  performance  acouraoy,  reliability, 
Maintainability,  coat,  eto,  Reliability  and  maintainability  are  enhanced  by  utilizing  proven  technology  and 
hardware  while  retaining  a  aimple  system  physically.  Performance  acouraoy  of  hardware  commensurate  with  tha 
reliability  and  nulntalnablllty  constraints  can  be  Improved  by  completely  integrating  the  navigation  senaora 
via  a  digital  intarfaoa  with  primary  control  in  a  general  purpose  con®  Liter  with  the  controller  being  a  Kalman 
filter. 

The  eyetem  deaoribed  and  analysed  herein  employe  a  classical  dead-reckoning  navigation  ayitam  to  provide 
lnatantaneoue  poaltion.  Cbaranterlatla  of  all  dead-reckoning  aystebi  ia  tha  monotonioally  growing  arror  function; 
banco  a  navigation  aid  ia  required  to  constrain  the  long-tera  positional  stability  of  tha  lyetam.  Tha  Navy 
Navigation  Satelllts  Spates  (NWSB)  provides  an  independent  meaeure  of  poaltlcnal  lnfornatlon,  and  this  infornatlon 
le  uied  to  optlnaliy  reset  and  calibrate  the  deed- reckoning  eyetem  which  containe 

(1)  A  Doppler  eonar  to  Measure  ehlp' e  velocity. 

(11)  A  gyroceapaem  to  provide  a  measure  of  ship' a  heading. 

(ill)  A  velocimeter  to  provide  a  measure  of  tha  spied  of  sound  in  water, 

(lv)  An  inclinometer  to  provide  m  measure  of  ship’ e  pitch  and  roll. 

A  -general  purpose  digital  eoapnter  in  which  mil  the  mechanization  equations  ara  laplaaentad  la  tha  oantrml 
oontroller, 

Section  a  contains  a  description  of  tha  operation  for  aaoh  of  the  four  basic  sensors  and  the  NNss,  A 
generalization  from  tha  baslo  lmplamantatlon  to  the  fonet  compatible  with  a  Kalman  filter  implementation  le 
presented  in  Section  3.  Alio  contelusd  le  a  development  of  the  pertinent  filter  mechulzmtlon  equations  and 
real-time  mechanisation  constraints.  A  performance  aweary  for  various  environmental  and  dynamic  conditions  is 
praaentad  in  Section  4,  whloh  Illustrates  tha  feasibility  of  utilising  a  Kalman  filter  to  i Kirova  the  Integrated 
eyetea  performance  accuracy. 


I.  SYSTEM  DESCRIPTION 
S. 1  Integrated  System  Concepts 

The  primary  objective  for  the  Integrated  eyetea  am  configured  ia  to  automatically  provide  continuous,  aoouratf, 
real-tine  gaodatlo  position  while  In  no  way  coaproilslng  system  opiratinn.  As  a  result,  an  lvroved  self- 
con talced,,  shlpborne  navigation  system  la  synthesised,  aaploylng  aiveral  'discrete  navigation  subsyatans.  figure  1 
la  a  functional  block  diagram  of  thw  ayataa  which  contains  tha  basic  const ltuentK  is  solid  blocks  and  optional 
navigational  aysteas  ara  shown  in  tha  dashed  blocks.  Icatantanaoua  position  velocity  and  beading  ara  derived  ■ 
from  tha  outputs  of  the  Doppler  sonar,  gyrocoapaas  and  vaioclnatar  with  long-tarm  poaltion  acouraoy  stability 
prassrvwd  via  tha  aatalUta  fixei.  Tha  nuclauu  of  tha  ayataa  ia  tba  interface  unlt/coaputar  complex.  Within 
tha  ooaputwr/lntwrtaoa  all  signal  tranaeliglon,  conditioning,  mixing,  and  optimal  filtering  ia  implemented. 

Tha  oowutar  rscalvaa  ship*  a  tora/aft  and  port/starboard  valooity  (frequency)  components  from  tha  Doppler 
sonar  and  oerreots  than  for  aptad  of  sound  anoulles  derived  from  the  velocimatsr  data.  Tha  component  velocities 
are  corrected  for  tha  ship's  pitch  and  roll  by  tha  vertical  reference  unit  and  ara  resolved  about  tha  eyrocuapasa 
heading  input  to  produos  ship'  a  North  and  East  velocity  coeponante,  A  numerical  integration  ia  oentinuoualy 
performed  to  coapute  ship'  a  latitude  aod  longitude.  An  independent  absolute  position  le  calculated  at  the  end 
of  every  satellite  pase,  and  a  eyetem  poaltion  update  ia  autoeationlly  obtained.  This  update  ia  derived  using 
the  optimal  (Kalian)  filter  and  tha  satellite  poaltion  observation  data. 

Tha  optional  ftaturaa  which  can  be  incorporated  in  tha  ayataa  to  allow  coapletw  ayataa  automation  ara  as 
follows: 

Alp's  ataarlng  nomoaoda  can  be  generated  In  tha  comutar  and  sent  to  tha  autopilot. 

Point-to-point  navigation  options  can  be  provided. 


Automatic  tlilni  sequence  control*  t*  t  function  of  distance  traveled  along  couraa  or  elapsed  tine  are 

t*n*rat*d  for. data  acquisition  systems. 

Real-time  data  logging  for  poet-mission  analysis  can  be  lmplenantad  through  the  uae  of  a  magnetic  tape  racordor. 

Ship' a  track  nay  be  plotted  through  the  uae  of  an  Incremental  plotter. 

Each  primary  tensor1  a  operation  and  thoory  la  delineated  below. 

2.2  Syaten  Deecrlption  and  Theory  of  Operation 
2.  2. 1  Navy  Navigation  Satellite  Syaii* 

The  Navy  Navigation  Satellite  (NNSS)  la  a  world-wide,  all-weather  ayatee  from  which  accurate  navigational 
poaltlon  fliea  can  be  obtained  from  tha  data  tranamltted  from  the  orbiting  eatelllte.  The  NNSS  conalate  of 
four  near-earth  orbiting  aatellltes,  four  tracking  stations,  two  Injection  stations,  the  US  Navel  Observatory, 
and  a  computing  center,  Any  number  of  shipboard  navigational  installations,  such  as  that  summarized  above,  can 
eiiat. 

The  navigation  satellites  ar*  placed  in  a  circular  polar  orbit  at  an  altitude  of  approximately  GOO  nautical 
alien.  The  orbital  planes  of  the  aatellltes  have  a  cobmo  point  along  the  earth’s  rotational  axla.  The 
geemetrloal  placement  of  th*  orbiting  aatellltes  allows  an  aarth  bound  observer  to  cross  directly  under  the 
satellite  twice  dally.  The  observer  raealvea  data  from  th*  aatellit*  twice  eaon  time  he  la  near  the  orbit 
because  the  satellites  appear  to  travarse  longitudinally  as  the  earth  rotates.  A  aaxlium  of  16  fixes  is  poasibla 
at  the  equator,  Realistically,  about  12  fixes  daily  can  be  realired.  The  number  of  fixes  available  varies  as 
a  function  of  user  latitude,  as  can  be  seen  in  figure  2. 

Each  aatellit*  orbits  th*  earth  in  approximately  101  ainutea,  which  is  00  minutes  between  passes  plus  roughly 
It  ainutea  of  tracking,  Through  its  useful  life,  each  aatellit*  continuously  trananita  th*  folluwlng  phase- 
aodulatad  data  at  two-minute  messages  on  two  radio  frequency  carriers:  two-oinute  Mark  synchronization  signals, 
a  400  Ha  reference  signal,  fixed  and  variable  parameters  describing  th*  satellite’ s  polar  orbit. 

Th*  classical  utilisation  of  th*  aatellit*  data  to  coaiput*  a  position  fix  is  similar  in  concept  to  any  hyper¬ 
bolic  positioning  system  where  the  aatellit*  simulates  th*  multiple  transmitting  stations  by  its  Inherent  motion 
relative  to  the  user,  figure  3  illustrates  th*  relative  geometry  of  th*  user  and  th*  satellite.  Pt  ,  P,  and  P} 
•are  three  distinct- posit Iona  of  the  satellite  during  one  orbital  pasa.  If  each  of  the  P's  differ  hy  two 
alnutse  in  time,  th*  distance  between  points  la  about  960  Im,  This  separation  is  comparable  to  baselines  on  the 
hyperbolic  radio  positioning  systems.  Tits  earthbsund  navigator  lies  on  the  surface  of  a  hyperboloid  generated 
f.vos  the  satellite  information  from  any  two  successive  points.  Th*  intersection  of  two  or  nor*  hyperboloids 
uniquely  locate*  the  esrthbound  user' s  position. 

Addltlonil  dsta  points  can  bt  used  to  establish  th*  ueer’  a  position  nor*  accurately.  A  eatlsum  of  R  data 
points  (Pj)  ar*  available  during  a  aatellit*  pass;  however,  assy  faotore  such  a*  geometry  (low  elevation),  radio 
laterferanoe,  etc.,  can  caucc  data  to  he  sliced  or  b*  Invalid, 

In  determining  th*  Pt‘  *  and  establishing  th*  user's  position,  satellite  orbital  data  is  required,  as  wall 
as  aoas  measure  of  relative  distance  between  user  and  satellite.  The  satellite  transmit*  both  (lied  and  variable 
orbital  parametsrs. 

The  fixed  paraastsrs  describe  tbs  satellite' s  nominal  orbits  end  are  accurate  only  for  a  12  to  It  hour  interval. 
Th*  variable  parametsrs  dsscrlbt  the  fin*  structure  In  th*  satellite' »  nominal  orbit  ss  a  function  of  tics  and 
ara  correct  only  far  th*  ties  at  which  they  ar*  transelttwd  by  the  satellite.  Thus  ths  satellite's  memory  stores 
sufficient  variable  parametsrs  to  describe  Its  orbit  at  tso-alnut*  intsrvals  between  subsequent  Injection*  of 
data  into  its  memory.  All  dsta  transmitted  which  do  not  ohangt  ui  permanently  wired  into  th*  satellite'  *  memory. 

Th*  eatelllte  trenemita  *  stable  frequency  t  which  1*  received  by  the  user  and  designated  ss  fr  .  The  ussr 
in  turn  eowtporsn  th*  rsoelved  frequency  to  a  stable  oscillator  output  frequency  f(  to  produce  a  frequency 
difference 

*  *  fg  -  ‘r 

Plgurw  4  illustrates  the  relationship  between  the  frequencies.  Over  each  two-sioute  tia*  interval,  th*  number 
of  beat  cyolea  ar*  counted  or,  essentially,  an  Integration  of  tha  beat  cycles  It  accoapUshsd. 

This  information  can  be  dlreotly  related  to  changes  in  slant  ring*  from  th*  sitelllts  to  the  user  in  that  one 
frequency  oount  1*  equivalent  to  on*  wavelength  of  distance  traveled  by  th*  latellit*.  Reception  of  three  two- 
adnute  satellite  aesesgas  during  on  orbital  pass,  along  with  tbs  rslsted  Doppler  ehift  aeaeured  by  the  user's 
receiver,  defines  hyperbolic  conei  of  differential  slant  rings,  lntorssoting  at  ths  user’s  ship’s  position. 

Taking  data  over  a  minimum  of  three  Interval*  yields  two  liquations  in  the  two  unknowns,  and  hence  a  position 
solution  can  be  realised. 


510 


rroa  Figure  4,  ud  using  the  nrst  two  inttrvila, 

K, ’«  *  fts*4‘'  (f0-fr)  dt  =  (f#'-ftHt,-t,>  ♦  f„  (At,  -  At,)  ,  <2. 1) 

Jt 

uaing  the  assumption  that  ft  =  f,  ,  Also  At,  -  At,  la  ralatad  to  tha  alant  rang*  between  aatilllta  and 
reoeivar  at  P,  and  P,, 

At,  -  At,  ■  -<8,-8,)  ,  (2.2) 

whore  C  la  the  apaad  of  light,  and  S,  and  8,  art  tho  alant  ranges  fron  tha  user  to  tha  aatalllta  at  P? 
and  P,  ,  reapsotlvslj.  Subatltutlng  Equation  (2.2)  Into  Equation  (2.1)  and  aolting  for  tho  difference  In 
dlatanoa  fron  the  earth-bound  abiervar  to  t«o  aatallite  positions,  in  affect,  deterainee  the  baaollna,  a.g., 


■lailsrly, 


(2.3) 


(2.4) 


Noting  that.  tiM  -  t|  ,  where  1«  1,1  ...a  ,  multiplied  by  0  la  tha  dlatanoa  travalad  by  a  particle  of  light 
In  two  alnutaa  allowa  aoaw  alagillfylnt  aaauaptloni  to  ha  aide.  However,  f„  i  ft  +  Af  and  Af  la  vary  aaall 
coagarad  to  ft  ;  thus,  to  praaarva  eoaputatlonal  aoouracy,  tha  above  aquation*  auat  be  raarrangad  to  avoid 
soaputatlona  of  tha  fora  Af/f.  ,  Tbla  oan  be  aaally  aocoetillahad  by  ualng  an  additional  point.  Manipulating 
a  third  aquation  which  la  alallar  to  the  above  ylelda 

-8,+28,-g,  *  (2.8) 

-8,  +28,-8,  «  .  (3.8) 

where  tha  8,  are  function!  of  the  satellite  position  at  eaoh  point  1  ,  where  1  a  1,2, ...n  ,  and  the  observer 
position.  Htnoa,  two  aquations  In  two  unknowns  allow  thw  datarwlnatlon  of  thw  uaar’a  two  unknown  ooordinatas, 
latitude  and  longitude.  An  alternate  l.aplesentatloa  la  to  use  a  diraot  ranging  approach  whloh  ob7lataa  the 
raquiraaant  to  ooaputa  position  froa  the  slant  raaga  data.  This  approach  tends  to  praaarva  aoouracy,  aa  the 
equivalent  of  HOOP  (Oeonetric  Dilution  of  Position)  is  not  axparlanoad. 


The  position  dataralnntlon  accuracy  was  aaan  to  be  greatly  affeotsd  by  tha  earth’  a  ataoaphara  and  gravity. 
Oravlty  aodal  raflnaaanta  have  oontlnuad  aloes  1940,  In  1984  tha  eighth  hsraoalo  and  order  tsra  (J,  ,)  In  tha 
gravity  expansion  aodal  was  Incorporated,  and  on  I  January  1988,  the  taraa  Jl3  ,,  ,  „  ,  Jtli  sod  J,,,, 

ware  added  to  tha  aachanlxatloni  a  substantial  raduotlon  in  position  datorilaation  lnaoouraoy  resulted.  Tha 
lnfornatloo  carried  in  tha  navigation  aaaaagsa,  which  are  phaaa-wodulatad,  la  dlatortad  by  tba  tropoaphara  and 
lonoaphara.  Thus,  the  earth's  ataoapbarlo  affaeta  ware  determined  to  be  functions  of  frsquanoy.  Tha 
tropoapbarlo  refraction  la  proportional  to  frequency,  as  la  tha  Dopplar  shift  which  oontalna  tha  usable  lnforaa- 
tlon,  and  oan  not  be  Isolated.  However,  tha  ionospheric  rafraotlon  was  observed  to  be  Inversely  proportional 
to  frsquanoy  and  could  easily  be  daterwlned.  To  inhsnoa  tha  ayatua  parforaanea,  tba  aatallltaa  transalt  two 
coherent  earrler  fraquanolaa  (189  HU  ud  4C0  Mb).  Thaaa  two  fraquanelaa  are  ooutrollrd  by  a  rafarsnoa 
oscillator  ud  oaa  frsquanoy  ia  an  exact  Multiple  (3/8)  of  tba  other.  Tha  sohual  truaaiaaion  fraquanolaa  are 
400  NHn  of  fast  by  32  KHx  (  399.964  KHz)  ud  150  HHg  offset  by  12  MU  (140.988  KHi).  This  allows  a  more  praulaa 
Doppler  oount.  Let  f„  and  fL  bo  the  raipaotlva  high  and  low  frequenoieg  tranaaittwd  hy  tba  aatalllta;  than 

f*  *  hft  ,  (2.T) 

Aara  k  =  8/3  .  Tha  frequencies  rwoaivad  on  tha  high  tod  low  ebannwls  raapaotlvaly  are 

*h,x  s  *8  +iafH  + 

<*,t  ■  *t  +  °i.  ■  <*•*> 


kploylog  the  observed  results  of  frequency  distortion  allowa 


W. 


+  kAf,v  _. 


(2. 10) 
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Solving  for  *H  iron  equations  (2.8)  nnd  (2.8)  yioldi 
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which  in  tbo  Doppler  refraction  correction. 

Sinoo  tho  satellite  transmits  circularly  polar  lead  elenal*.  either  circularly  or  linearly,  pnixriaed  receiving 
antennaa  can  bo  uaad.  However,  if  highly  dirootional,  narrow-bend  anttnnai  aro  und,  tvo  antennae  aro  required, 
ono  far  oanh  oporating  froquanoy,  or  a  aingl*  broadband  antenna  daaignod  for  dual  fraqutnsy  operation  nay  be 
uaad.  fbo  antennaa  uaad  are  larger  and  more  difficult  to  handle  than  the  aimpleet  antenna  ertutiuwmenl  which  la 
eoaposad  of  two  whip  antennaa,  one  for  tech  frequency;  however,  thin  ahould  be  avoided,  if  possible,  since  the 
whip  baa  an  overhead  null,  and  aatelllte  data  would,  therofore,  be  loot  for  satellite  paaaes  of  nore  than  70° 
elevation  angle.  The  elevation  angle  Halts  on  satellite  coverage  do  exceed  this  value. 

The  aatelllte  aigsala  are  received  by  the  user  froa  the  tine  the  approaching  aatelllte  rises  above  the  radio 
borlwon 'until  tbs  tiwe  it  seta.  Tho  motiving  antenna  patterna  should,  therefore,  provide  couplets  overhead 
coverage. 

8.8  Velocity  Measuring  Subsystem 
3.3.1  Sonar  Doppler 

The  toner  Dop.il ar  provides  a  preoiae  mossursatnt  of  ship' a  fora/aft,  port/starboard,  and  up/down  volooity 
rolative  to  tho  earth  for  wator  depthe  up  to  800  foat.  The  sonar  Doppler  li  a  two-axle,  bottoa  referenced 
speedometer  which  dorivts  its  Information  from  hi|h  frequency  sonar  signals  aaitted  from  a  tranamlttar  on  the 
boat.  The  baalo  operation  la  dallnaatod  below, 

Tho  Doppler  system  employs  beams  of  ultrasonic  energy,  directed  obliquely  at  the  ocean  floor  at  an  angle  of 
y  degrees  relative  to  the  vertical,  to  obtain  true  velocity  measurement*  in  the  fore-aft  and  port-starboard 
directions  and  th*  up-down  axia.  Bioauao  tho  piteh,  roll  and  hoavt  of  the  ship  add  othor  apparent  notions 
ralativa  to  tha  ocaan  bottoa,  ths  Dopplar  aystam  ahould  ampler  Pairs  of  beam  (one  pair  angled  fora  and  aft,  tba 
other  angled  to  port  and  starboard,  ace  Figure  8)  to  compensate  for  tbaao  motions.  By  averaging  tha  fraquanoy 
difference  between  fora  and  aft,  and  port  and  starboard,  tut  true  velooltlea  are  deiermlnad.  Tha  oonoapt  of 
four  beaaa  is  an  application  of  the  Jnnua  configuration  which  ia  common  In  airborne  Dopplar  radars.  A  primary 
■aaamon  for  .using  ithlm  configuration  ia  for  the  cancellation -of  errors  which  raaulta  froa  averaging  tho  return 
signals  in  tha  signal  prosoaalng. 

Typical  sonar  Dopplar  sensors  utilise  a  300  BHs  sonar  signal  In  i  pulsed  transmission  mod*  of  operation. 

Signal  feedthrough  froa  tranamitter  to  receiver  ia  eliminated  and  axoallant  algnai-to-nolie  ratio  oharaotarlatios 
art  obtained  eith  receiving  circuit  gating  and  tlaa  varied  gain,  Tba  pulsed  operating  node  provides  a  signal 
ampUtuda  sufficient  to  supply  aoourat*  signal  data  at  vassal  ovar-the-botton  operating  height*  up  to  800  foot. 
Beyond  840  to  880  feat  tba  syatea  automatically  looks  on  to  the  water  scatter  return;  tbs  eonar  energy  la 
reflected  froa  small  aoattarera  present  In  all  oceans.  Tha  electronic  anting  la  set  to  observe  this  reverberation 
return  only  from  the  undisturbed  wntar  below  tho  ship,  tbus  excluding  tbe  offsets  of  turbulence  and  boundary 
layers.  Tha  ruault  is  a  highly  accurate  and  reliable  indication  of  tba  ship’s  trua  velocity  relative  to  tba 
ocaan  bottoa  up  to  POO  fast  and  ralativa  to  tha  water  aiss  at  all  greater  depths. 

Thus,  tha  water  ease  return  repreaenta  vehicle  notion  relative  to  the  sea  and  tba  eiptoted  aoouraoy  la 
degraded  by  the  unknown  ten  currents  which  are  typically  on  tho  order  of  0. 5  to  1. 0  hnote  for  short-term 
correlated  noise.  The  eonar  acouraoles  art  tabulated  below. 


Ifater  Depth  (ft) 


Typical  (It)  Accuracy  (%) 


400  -  800  Bottoa 

Qrsster  than  600  Voluaw  reverberation 


An  error  source  which  la  additive  to  tha  on*  shove  ia  the  rioiivar/trao Slitter  electronioe  nolee,  thioh  ia 
approximately  0.02  hnote.  The  primary  contributor  ia  the  crystal  controlled  oeoillator  which  is  stable  to 
•Itbla  0.014.  Tho  biggest  concern  In  toner  performance  is  that  in  ths  reverberation  mode  the  eoa  current  notion 
must  be  statistically  added  to  ths  uonar  error.  Tyrloal  random  its  current  drifts  are  on  the  order  of  0.8  knots 
to  1.0  hnotm,  depending  on  the  ties,  with  typloml  correlmtion  distances  of  18-20  neutloal  milts,  ueumlng  a 
Omnmsian  distribution  with  exponential  autocorrelation  function. 


MAjor  contributing  error  aouroec  in  a  conventional  uuaugmented  Doppler  mechanisation,  which  ere  eliminated 
In  the  Integrated  meohenlxatlon,  ere  the  errore  induced  by  the  vehicle  pitch  and  roll  dynamic#,  The  pltoh  and 
roll  angular  revolution  till  be  meeheniacd  end  will  yield  negligible  errore.  It  the  reiolution  la  not  implemented, 
the  following  velocity  errore  per  alia  reeult; 

U)  Due  to  ateedy  atate  pitch  (trim)  and  toll  (lint), 

iV  Or  A^'/dSTO  , 

where  b&  le  the  pitch  or  roll  angle  in  drjrtee, 

(li)  Due  to  dynamic  pitch  end  roll  (einuaoidal) 

SV  2f  0.  10 1  bp*/ 6610  , 

where  bp  le  the  amplitude  of  the  pitching  or  rolling  notion  in  degree*. 

2.3  5  Vertical  Ptftrtn ct  Unit 

The  vertioel  roferonce  unit  meaauree  whip’ a  pitch  gad  roll  through  which  the  eonar  Doppler  outputa  are 
reaolvod  to  eeeontlally  create  a  atabillaed,  looally-level  coordinate  frame  in  which  the  aystem  velooitlea  are  ' 
eapreaaed.  The  baaio  aenaora  in  the  vertioel  reference  unit  are  two  elngle-aila  fluid-damped  penduluma 
(lDClinometere)  which  output  the  deflection  of  the  whip  fro*  the  local  vertical.  Their  outputa  are  whole' augle 
indication*  of  chip' a  pitoh  and  roll.  Theae  anglea  are  then  uaed  to  generate  the  Euler  tranefornation  matrix 
oonalatent  with  the  rotational  dynamic a  of  the  chip. 

2 .3.3  Viloe imtttr 

The  velooimater  le  a  precision  lnetrument  for  meaauring  the  velooity  of  Bound  in  water  .o  an  accuracy  of  one 
part  in  ten  tbouxand.  Ita  output  la  uaed  to  weight  the  aonar  Doppler  output  pulaaa. 

The  operation  of  the  velooimeter  la  baaed  upon  the  alng-around  principle.  A  pair  of  plcxoeleotrio  oeranlo 
tranaduoara  and  two  reflector*  are  mounted  to  fora  a  aound  path  of  fixed  length  in  the  water.  In  operation, 
a  pula*  of  aoouatlc  energy  la  tranaeltted  through  the  water,  received,  aaplifled  and  uaed  to  generate  another 
pula*  of  aoouatlc  energy.  The  repetition  frequency  of  thin  regenerative  action  la  dependent  upon  the  traneit 
time  of  the  elgnal  pule*  and  ix  therefore  a  meaaur*  of  the  propagation  velooity,  Error*  reaultlng  from  the  flow 
of  water  along  the  wound  path  length  are  mlalmixed  by  folding  the  aound  path. 

The  baaio  parameter*  which  caue*  a  variation  in  the  epeed  of  aound  are  water  teeperature,  preeaura  and 
•allnlty.  A  typical  expreealon  for  cT  la 

Oy  ■  4429  +  11.  2ST  -  0, 04BT*  +  0,0 IBM  +  4.3(8-34)  ,  (9. 13)  . 

■here  Oy  la  ln'ft/ieo,  T  la  temperatura  in  degree*  Fahredhelt,  d  le  depth  In  feet  and  S  la  aallnlty 
in  parte  per  thoueand.  The  primary  iteaa  of  conoern  in  thia  expreaiioc  are  ea  follow*: 

(»)  Teeperature  -  a  90  -  29  degree  r  variation  can  be  expected  between  low  latltudea  to  polar  areas. 

(b)  Salinity  -  large  varlatlone  can  occur  if  the  vehicle  1*  lu  containing  wait  water  ourrenta,  or  near  river 
outleta. 

3. 3. 4  Gyrocompatt 

The  gyroaoawaa*.  with  lte  Integral  gyroioope,  ia  controlled  euob  that  it  oontinually  align*  ltielf  with  tb* 
aer id lan  and  track*  trua  north.  Haaoe,  ita  natural  output  i*  ahlp’a  heading.  Sonar  Doppler  velooity  component! 
in  the  etabllixed,  locally- level  plan*  are  reaolved  about  heading  to  provide  ebip’e  velooity  component*  in  north 
apd  eaat  oomponentm.  Figure  1  Indicates  a  feedback  torquing  lignal  from  thv  computer  to  compeueate  for  the  ebip’  ■ 
inatantaneou*  poeltion  and  epatial  rat*.  In  tb*  gyroconpaae  error  model  whloh  1*  presented  in  the  following 
eeotlon,  all  gyro  drift*  are  aeaumed  to  be  either  deteninietic  or  to  poeieea  exponentially  autooorrelatad  noli* 
function*. 


I.  gVgTEM  ANALYTICAL  SODBL 
1. 1  Ictroduotion 

The  integrated  *ultlleeneor  marine  navigation  ayitem  defined  in  Section  2  employe  optimal  algoal  prooeaaing 
and  aultlply- redundant  navigation  data,  in  th*  fora  of  ranga  and/or  range-rat*  or  range-difference  and/or 
ransa-rata-dlfferenoe,  in  ayntheiialag  miniaua-varlaao*  atate  veotor  eetlaate*. 

The  atate  variable#  of  the  etat*  veotor  oonalat  of  poeltion,  velocity,  heading  and  tb*  atoohaatlo  model*  of 
tb*  eeneor  error  eourcee,  Th*  optimal  eatlmat*  of  th*  navigation  variable*  arc  employed  in  updating  (1.*.,  aervolng 
cr  correcting)  the  navigation  ayetem;  th*  prediction  of  th*  eeneor  error  cbaraoterietle*  lead*  to  oroee-oelibratioo 
of  eeneor*;  thui  th*  navigation  performance  1*  further  enhanced. 
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The  physical  dynamics  Involved  in  opt  lull;  laplenentlni  th«  aultiaenaor  neviietlon  ijitti  require  a  pnolit 
definition  of  the  propiutlon  of  Uneirlzcd  error  dlfferentlel  equation!  oheraotorUtle  to  the  Doppler- Booar 
gyroeownas  system  augmented  by  the  eetelllte  dsti  processor 

In  the  optinua  linear  continuous  eetlaetore  the  ayeten  error  state  vector  la  defined  by  the  relationship 

i  =  AX  +  U  ,  (3. 1) 

share  X  is  the  D-dimensional  error  state  vector,  A  lean  n»n  coefficient  eatrie  and  d  in  atnte  noise 
yeotor.  The  eorrespondlm  discrete  equation  la 

[X]kn  *  Wk*,lkMk  +  t»]k  .  (3.3) 

share  4  la  the  sell  known  state  transition  antrix  characterising  the  error  transition  from  kth  to  (k  +  l)tk 
iteration. 


3.3  syatea  Sensor  Error  Models 

The  priaary  syaten  sensor  (l.e. .  Dopplsr-Bonar  (D/S),  gyroeonpaea  and  satellite  receiver)  error  node's  are 
usually  obtained  by  a  first-order  perturbation  of  Mohanisatlon  equations. 

The  (D/I)  awohanisation  equations  are 

PI].  •  tTjtV"]  .  (3.85 

share  (V,)*  a  [V.V.vJ  is  the  velocity  vector  defined  In  the  ship's  static  coordinate  syutea,  (V;')T  »  [v^'v”vn] 
is  the  velocity  vector  defined  in  the  ship's  dynaaic  (i.e. ,  pitched  and  rolled)  coordinate  eyatea*  and  the 
natrii  [T(]  provides  transforMtlon  from  ship*  s  dynaaic  to  state  coordinate  systeas. 

The  ship’ s  velocities  in  tbs  naviiation  coordinate  ayeten  are  obtained  hy 

W1|T  -  [*,]»,].  .  (3.0 

share  CV]!.  «  Cv.VkV0]  is  the  ship’  a  sea-track  velocity  vector  defined  in  a  (east,  north,  up)  coordinate  ayeten 
sharlu  the  seas  origin  of  the  ship'  a  coordinate  systeas,  The  aatrix  [t,]  provides  transforantlon  tree  ship’ s 
static  to  naviiation  coordinate  aystiai.  The  ship*  s  velocities  are  resolved  throuih  the  sea-track  heading 
.angle  0|¥  to  , northerly  .and  . easterly  oooponsnts. 

Coablnlns  Equations  (3.3)  and  (8.4)  yieldn 

[»„]  «  CT,ic?'»3  .  (3.3) 

share  tT,]  •  [T.Ht,]  ,  (».#> 

Hosaver,  If  the  D/8  ayatea  la  operated  In  tha  voluaa  ravarberatlon  aeda,  a  aaa  currant  vaotor,  WJJ0  ■  tv^V^O]  , 
aunt*  be  eubtraated  froa  Equation  (3.8).  Hanot 

«  Ct,3 [vjl  -  W18k  (s.T) 

there  K>1  (1  =  0.1)  In  the  bottoa  and  see  roluae  rsvsrbsrstlon  nodes,  respectively. 

The  latitude  and  loniltude  rctea  of  the  ayetse  are  obtalnad  by  dlvldins  sea-tuck  velocity  covenants  Uy  the 
radii  of  curvature  of  ths  earth,  rirat-ordsr  psrtuvhatlon  of  these  rstee,  ne*l»ctln*  eeoond-order  terae 


yields 


*S  *  **« 31 0  • 


s  A. 


*s 

8Vk  8AV1aln\ 
r.ToTA  A,  oas!\ 


•hero 


(i  *E,  N)  are  ths  radii  of  curvature  of  tha  earth1, 


(3.8) 

(3.9) 


All  coordinate  systsss  used  ere  Cartesian,  right  hand  oriented. 

♦  ass  current  velocity  vector  Is  defined  In  the  nevlintion  coordinate  eyatea  end  is  resolved  tkruush  the  see  current  heedlns 
sails  to  the  northerly  end  easterly  ooaponents. 


The  velocity  error  rate  equations  obtained  (run  Equation  (3.7)  In  soalar  fora  nre 


•  {i$t  co»  0,  -  5V,0a  i in  0a  -  Ssi#V{  sin  0„  -  S0„'i;  tin  0a  - 

-  *0aVfvL  «°s  0a  “.*♦»  ,lr‘  0o  "  svs0o  °°*  0o  " 

-  S0aV,  oos  0,  -  J0aV,  ooi  0#  +  60aV,0o  tin  0a  - 

-  S#ta  cos  01O  -  SVt0^a  sin  0,a  -  50,aV,a  sin  0IO  - 

'  ®0sAo  ,ln  0.o  ~  J0.ov«o0.c  “*  0.o^  <*■  »> 

*  (SVf  sin  0a  +  SV,0a  coo  0a  +  S0aVf  00*  0O  +  *0o^f  00*  0o  " 

-  S0aVf0a  sin  0a  +  5V,  ooi  0a  -  5 V,*4  sin  0„  - 

-  50aV,  sin  0a  -  50a'>,  sin  0a  -  50aV,0a  eo»  0a  - 

*  »i»  0,o  +  «Vto0.o  cos  0,e  +  80,OV,O  cos  0,o  + 


+  *0,o^io  ««“  0,o  -  !0iovoo0.o  ,ln  0.o]  <»•  »> 

«♦„  »  -  6$D.  (3. 13) 


I0,c  ud  JVaa  sro  aodtled  u  tlae-oorrelsted  noils  sourcts,  Tht  20la  snd  l\a  tsras  have  saoond-order 
eft.nts  which  srs  no, loot sd.  lbs  JVj  (i»i,f,D)  srs  sodslod  ss  tiss-corrslstsd  soils  souross  snd  S\L 
(1  *s,  f,D)  tons  srs  prsssstsd  in  Motion  3.3.3. 

'  3.3.1  Cyroeoapaii  Rati  Error  Equation i 

A  iyplesl  t«o-di|rss-cf'trs.doa  syrocoapas.  is  shown  in  fi*urn  a.  Tbs  rstss  sensed  by  hhe  syro  compose  srs 
oontslnsd  in  thi  brsokstod  tsras.  In  theory  the  compensation  of  ths  brsckstod  tsru  is  impleaented  by  opplyinc 
■igssls  of  tbs  seas  Minltuds  but  of  oppoiitc  sisn  to  ths  aorriipondina  sunlni  lunations.  In  practice,  however, 
ths  insaosMiblUty  of  ths  sunnini  functions  requires  coopon.stini  tsras  to  bs  sppiisd  to  ths  lsvsl  snd  ssisuth 
or  to  lsvsl  (only)  torqusrs  of  ths  lyrocoipssi.  In  ths  snslysis  bslow  s  thsorstiosl  oospsnsstion  sothod  is 
mused;  this  deviation  fraa  ths  prsotlos  slspllfiss  ths  ooiputsr  sisulstion  of  imr  squstlons  snd,  moot 
lsportsntly,  yields  in  univsrssl  srror  sodsl  aospstibls  with  sost  cyroooispas.es  iviilsbls, 

lbs  srror  psrforasnos  iu  snob  osss,  with  fow  ejc.ptions,  yields  tbs  sus  rssults. 


Dsfsrrlnq  to  riture  8,  ths  first-ordsr  perturbation  of  ths  ssobsnisstion  squstlons,  snd  sssUnlni  SR1 
(1  ■!,  N)  »  0  ,  8Kg  it  0  .  ana  o  ,  jKg  a  0  ,SryQ  ,  A.5COXX5A,  ,  |50»kD5AH  ,  yields 


(3.  13) 

(3.  14) 

(3.  13) 


lbs  20t  tors  in  Iqustlon  (3,14)  1,  th,  residual  torquini  srror.  Ths  ti  (i  s0,ij)  srs  ths  total  lnstruasnt 
drift  errors  due  to  bins,  noise  (short  ind/or  Iona  oorrilated)  wsrs-up  noise,  soil,  factor  srror,  non- 
orthoionsllty,  mss  unbslsnos  (i-ssnsitivs),  snisoslsstioity  (|?- sensitive).  Ths  orthoionslity  srror  miles 

sad  ths  soils  fsotor  errors  srs  aultiplisd  by  ths  oorrsipondlni  total  rstss  (l.s. ,  vehicle  and  osrth  rstu).  Tht 
Equation!  (3.13)  and  (3.1i)  art  valid  whether  tht  gyroeoapait  consists  of  too  iinglt-dtgrit-of-frtidom  gyroi  or 
a  too-dtgnt-of- frttdoa  gyro.  Ths  nuabsr  of  elements  to  bs  impleaented.  in  the  on- hoard  ooaputsr  is  diotitsd  by 
tho  saoursoy  requirement.,  sssory  sllotssnts  sod  ths  typo  of  oospsnsstion  used. 


3.3.3  Dopphr/Sonqr  Error  Equation 

Tbs  Dopplsr/Sonsr  output  is  ths  cilibrstsd  velocity  vsotor  defined  in  ths  ship's  dynssio  coordinate  frame, 
l.s.,  (V")T  a  <vj'v;;v")  , 

Itaferrlai*  to  Motion  3, 


*  la  Iqnatlone  (3. 18)  throush  (3, il)  the  sonar  beaa  anils,  ar.  a.. used  to  bs  30°,  measured  froe  the  v.rtloal  (does)  direction. 


(S.  lfl) 


Vi'  *  -J-!  (Af,*f,-f,) 

i  Sft 

v»  "  %“  <*WV 


v^' 


!*  (3*  -  A  .  !*.  /E£f  -  i') 

/S  \3ft  j  Vi  \ut  ) 


*VJ 


ait  +rf,-4ft>  ,  <zff*ff+*a> ,  cEf.sf.  +  tp)  , 


a  tv 

(3.  18*) 

(3. 18b) 


«h*r*  tt  ,  f,  ,  f,  uid  ip  are  th'  for*,  art,  »t*rbo»rd  and  port  tran*duo*r  fr*quenoy  output*  of  th* 
tranaduoer;  ov  1*  th*  valoolty  of  propaaation  of  aaund  in  th*  *•»  nediua.  Th*  ft  1*  th*  traniaittlm 
frequeney. 


Canblnini  Equation*  (3.16)  through  (3.16b)  with  (3.3)  tnd  first-order  perturbation  of  the  result,  with  the 
asauaptiona  5<Af{)  t:  0  ,  S cAf„)  t»  0,  yield* 


»Vf 


‘  t;)  00,9  *  TZ  (*f‘ +  Zf* '  4f‘) 


-  (85)  [Aff  .in  5  -  ~  (if*  *  If,  .  4ft)]  4 

+  (*S*f  +  aif,-48ft]^|  <3.»> 

8V.  ■  (^){(^f  ■  ,itt? + Af* CM  f  -  k  at< + 

t  If,  -  4ft)  ala?  ooi 4  36  £kfg  oo*  6  ain?  4  ala?  ala 5  « 

«  """**)]  +.  *^*f  eo#  ?  »1B®  “  Af,  ,la  v  “ 

■  °“9  00,9  (-*"*^“*)]  -  (“Jr*-)  [*»«  4 

4  8If,  -  48f,^  ,  <8. 30) 

Equations  (3. 19)  and  (3.  30)  oontaln  th*  !V^'  tart.  ?  and  9  ,  of  th*  trl|oaoa*trlo  tern*  shorn  in  th* 
•quatloaa,  ar*  th*  roll  and  pltoh  angle*,  respectively,  Th*  osrrtipondini  pitch  and  roll  error*  (i.*,  85  and  Sip) 
ar*  dua  to  attitude  raadout  or  luoHaomrter  readout  error*  and  pltoh  and  roll  aaplltud**  and  fraqusuojr  error*, 
1.*., 

■85  a  85,  4  85,  uino^t  4  8wp5§  oo* ugt  4  n(5)  (3, 3i) 


89  a  8?0  4  8?,  ala  (y  4  y)  4  8cy?,  oo*  (cy  ry)  t  n(?)  .  (8. 33) 

Th*  [8oi.(l*5,qi)  •  JrrJfj]  la  a  function  of  th*  abip'  a  dynaalo*;  y,  la  an  arbitrary  pita**  an*l*.  Th*  nola*  t«rn* 
a (1)  (1*5,?)  ar*  defined  by 

«{ni(i)[aJ(i)]T>  ■  8kjQ(l)  ,  (9.33) 

«h*r*  8kj  1*  th*  Iroitiokar  delta  and  4(1)  la  th*  *o-oall*d  ehlt*-aoi*«  variance*  . 

3.3.3  Viloeiuttr  trror  Equation* 


Mfarrlai  to  («etion  3.3.3,  th*  r*looln*t*r  output  la  d*fln*d  by 

Cy  ■  <4433  411.  38T-O.045T1  40.01830  4  4.3(8-34)}  , 


(3.  34) 


afcart 


*1  "  *  •  4  ^ 


0,  ■  apaed  of  toiwd  la  aatar  (ft/ato) 

I  *  wattr  ttaparatura  (>) 

D  ■  dtptb  of  traatduoir  (ft) 

■  »  aallnlty  of  fit  or  (port*  par  thouaind) . 

Ih»  ftrrt-ord.r  parturbatlon  of  Equation  (3,34)  ylildt 

*°r  •  11.35JT  -  O.OMST  ♦  0.01B35D  +  4,33a  ,  (Si  25) 

£!l!™d*  *££  01  tb*  d#Pth  °f  thi  tr*a*duc'r  ui  ••iiolty  of  aatar  an  aa.ll  and  h.no.  aay  bo 

«C,tr  (11,JB-0,0BT)  !T  ,  (J  28) 

Iht  rata  of  ohaata  of  tba  taaparatura  arror  la  aodalad  aa  to  axponantlally  oomlatod  oolao  proem. 

J.  2. 4  Mxftit  for  Enponintitilly  Corrtlattd  Noiu  Sourcts 

Iba  txpontutlally  oorralatad  nolaa  aouroaa  kj  ,  atatad  >n  prtnout  aaotiona,  art  aodalad  by 

«MJ  i  oja^M  ,  {llJ7) 

“f‘h*  »roo,“  «<•  “  t»«  lnvaraa  oorralatlon  tlaa.  Kota  that  Equation  (3.37)  It 

obtaload  bf  pasaloi  a  ahltt-nolta  promt  through  a  flrat-ordar  flitar.  ' 

3.S.5  Iht  byttt*  Stott  Transition  Ihtria 

Iha  a quit loot  praatbtad  la  baotiona  3. 1  and  3. 1. 1  through  3, 1.3  a ra  la  tha  fora  of 

I  ■  «'  +  »  .  (Ji JB) 

Tha  atata  traualtlod  aatrla  #  la  dtflnad  bp* 

•XP  (Jr^  AW  dr)  a  |l  +  JA(r)  *r  4  i  ,^Afr>  trj  4  1  ^A(r)  drj  . . ,  »> 

Captation  of  atob  tara  rialda 

A<r)  ■  ,  At  +  rA,  +  ~  A,  . . .  j  (3.30) 

£V)dr  a  ,  j  (».«!> 

(C  *<T),tr)  ■  |*5  ♦  <*!*»  ♦  A(*0)  — j-  |  (3.33) 

ftV>*r)’  “{*/**  •”}•  <*3S> 

Mtnoa 

«(|;4tA(r)dr)  -  |i^tf.,+|-(A,Mj,t^[*0+i(AA,+A0v+A;]4...} 

Mob  txpaMloo,  hoaaTar.  baa  aoaa  Matrlotlona',  Aaaualoi  it  to  ba  aaall  and  A(t)  oonatant  durina  tha 

*1  I  *iWPl*  TwI°r  M,rlM  ,Ifl“,lon'  »•  ooaputatloo  of  Equation  (3,34) 

.  ‘*T  *°  th,t  *ddUi0B»l  ‘Of"*  naiUilbl.  by  ooaparleoo  altb  tha  partial 

Z  2rE  JSS  tb.  SJtS?"  “  *  Wt"  **  ,Ut*  tr“•tU0,,  Mtrli  U  ,0,put,d  *W  “•“"‘tin, 

Oala«  tba  abort  approjiititionn  alloaa  arltloa  tba  dlaorata  fora 

"k*!  "  **»  •  (3.J3) 


*  !Lt\r*'1,  tr“°M1°a  b,WDd  **0  t,r*  for  up  to  4  bouri  of  aarltatloa.  ulth  At  .  10  ho,  mid.  La. 

thaa  It  arror,  look  a  tithed  la  aqulraliat  to  aiapL  r.otuiulai  latiiratioo. 
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Th«  «t»tt  tranilticm  wit r lx  obUintd  it  in  th«  form  of 


Le  !J.J 


there  $u  end  4’1 ,  ere  derived  b/  forming  the  A  matrix  from. tha  equations  given  In  pr«vioui  Motion*.  The 
♦„  matrix  contains  exponential  term*  The  simulation  state  veotor  la  presented  In  Table  I. 

The  ahlp-borne  meohaniiation  of  a  lari*  atata  veotor,  aa  praaantad  In  Table  1,  la  conntrelned  by  aonory  and 
tba  computational  apaad  of  tho  computer.  Judicious  selection  of  atata  variables  throuth  the  usa  of  a  sophisticated 
simulation  progrw  will  (and  indeed  does)  raduaa  th*  size  of  the  state  veouir  to  lass  than  one  half  of  the  elzo 
shown. 

3.3  Kalman  Mechanization 

The  Doppler/'Sonar-iyrooonpuss  navigetton  ayatea  la  auimantad  by  the  NNSfl  (aoarated  Doppler  signals  received 
and  processed  by  thfl  raoalvtr,  Optimal  mixing  of  senior  signals  are  Implemented  by  the  Kalman  filter  (Ref. 4. 

Vo  1 .  Ill,  pp.  323-280).  The  Kalman  actuation*  era 

(a)  extrapolate 

*k  •  *\.t  *T  +  Vi  •  <*'S7> 

<b)  Filter 

K„  «  P^hJ  (H^Hj+l^)'1  (3.3*) 

P{  <I-*kHk)PM  (3.38) 

*Ia**k  +  Kk(nk-ak>  .  (3.40) 

Situations  (3.3T)  and  (3.30)  ara  the  oovariaaoa  of  errors  in  the  eatlsate  before  and  after  tba  updating  prooaaa, 
respectively*.  Tba  estimate  vaotor  la  set  to  aero  following  a  oorraotlon  aftar  each  update 

.J.JJ  The.  Slate  fates . Cover, tones  .Mat  ri*  Q 

The  state  nolee  oovarienoe  matrix  0  le  In  the  form  of 


Tl  I  0” 

\j>  kj 


The  0,|  aatrix  oonelsta  of  diagonal  elementa 


flj  m  o-J  <l-e**^l,lt)  , 


■bar*  <r\  la  the  varlenoe  of  the  prooeea  and  0l  la  tha  lnvaraa  oorrelatlon  tlaa.  If  the  correlation  le 
defined  spatially,  It  la  normalised  by  tho  ship’ e  sea-track  velocity. 

3.3.  2  The  Kaltan  Extraction  Matrix  II 

The  satellite  dynamic  signal  prooaiting  will  yiald  range  and  range-rate  meaaureianti.  The  prooesilng  of  the 
elsnala  Is  a  charaotsrlstlo  of  tbe  rentivor  uaod.  Corrospondlngly,  the  user  has  ths  options  of  available  optimal 
data-avaraging  teohnlnuea  and  inplemanting  range  and/or  range-rate  or  range-difference  and/or  ranga-rats-dlffarenoe 
aothods. 

-I 

Lat  Z  “  f (x)  define  the  actual  obiervation,  there  x  la  tbe  dynaulc  etate  of  tbe  eatelllte  and.  tha  navigator. 
If  Z  *  f(x)  la  axpanded  In  a  Taylor  earlea  and  higher  order  terms  are  argleoted, 

<i  •  I  a  HRt!,.  (3.43) 

there  n  la  tba  measurement  trror  vaotor  and  vt  la  tha  observation  noiaa.  The  H  matrix  shoe*  bow  tba 
obmarvad  errors  ara  .distributed  In  the  state  apace.  The  H  matrix  la  defined  by 

38  HU 

H  «  --  .  -A  .  (3.44) 

3x 

Let  the  dynimlo  aeanurenent  couiet  of  ruga  and  range-rats  vector,  t.a., 
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Tb«M  universal  nodal*  art  applicable  to  iny  navigation  satellite  system  For  example,  when  the  NNSS  1* 
uud,  onlyont  inttlllt*  par  observation  1*  available;  thu*  th*  u**r  may  prefer  to  proces*  range  only,  or  range- 
rat*  only  or  rangt  and  range-rat*  aodoli.  If  a  aonatallatlop  of  uttllitas  la  available,  as  In  the  TRW-Navatar 
system,  tbe  and  natrioee  are  computed  one  per  satellite;  for  example,  if  three  satellites  are 
slsultsneouely  available, 

H’  =  (HjHjH’  I  Hjlljllj]  ,  <3. 61> 

•bar*  aaoh  (1  =  1,  3, 3)  and  tlj  (i«i,  2, 3)  are  in  the  fora  of  Equation*  (3,55)  and  (3,00),  respectively. 
Not*  that  th*  number  of  satellite*  determines  th*  nuabor  of  roe*  of  th*  extraction  matrix,  if  a  dlfferenctlni 
■chen*  la  employed  In  a  oonetellation  type  system, 

Ht  =  [(H^-H*)|  (H^-Hj)j  (H^J  “M|>|  (H^-llJ)]  .  (3,53) 

1b*  differencial  scheme,  with  slight  modification*  in  the  transition  matrix,  is  also  applicable  to  the  NNSS 
(■ingle  satellite  per  observation),  l.e., 


Tyt=t,)  -  H„(t=tbf 

H>(tit.rri5rtatv 


(3.63) 


equation  (3.58),  1.*.,  Hlt  ,  must  be  computed  to  evaluate  its  numerical  significance:  for  example,  for  high 
altitude  satellites  it  may  be  neglected. 


For  th*  NNSS,  the  satellite  errors  are  not  carrisd  in  tbs  extraction  matrix  H  :  hanc*  Hu  ,  Hu  ,  H,,  ,  and 
H„  are  deleted,  1,  e. , 


(3.84) 


The  satellite  errors  which  are  not  lumped  to  th*  observation  noise,  v  ,  ar*  added  to  th*  observation  vector,  1.*., 

s  =  HSX  +  L(si)  v  v  ,  (3.65) 

where  L(*l)  is  defined  by  two  time-dependent  bias  and  noise  processes: 

L(ai)  »  S|(  jt  +  8,i  jt*  +  c,j  .  (3.66) 

Th*  ntl  ar*  sodeled  as  tine-oorrelated  noise  sequence*. 

■tn<1njl]  a  0,Jle*^*ilit  ,  (3.67) 

where  Sb  j  ,  6,^  and  n  ar*  approxlaated  identically  for  all  WSS  satellites*  and  ar*  added  as  state  variables 
46,  47,  4k  to  the  state  vector  preeunted  in  Table  I. 


Recall  that  tbs  state  tranaltlon  matrix  was  derived  in  terms  of  tbe  geodetic  coordinate  parsaieters:  thus  the 
covsriancw  of  errors  and  the  corresponding  error  vector  ar*  defined  in  th*  geodetlo  coordinate  system.  On  th* 
Cither  hand,  the  extraction  matrix  H  1*  derived  in  terns  of  geoceutrio  coordinates;  consequently,  the  observation 
vector  for  a  six-element  system  is  modified  as 


s  *  H*  5X  +  L(ai)  ♦  v 


where  T,  is  a  geodetic  to  geocentric  transforaatlon  satrlx  and  is  defined  by 


-sin  A  (-sin  \  oo*  A)  (cos  \  oo*  A) 

’c«. 

°x. 

=*; 

*.  - 

cos  A  (-sin  \  sin  A)  (cos  K  sin  A) 

cr* 

°ya 

cyu 

0  oos\  sin  K 

"me 

c.a 

C*1L 

(3.68) 

(3.69) 


(3,10) 


To  this  point  all  H  elesent*  correepondlng  to  th*  position  and  velocities  ar*  defined.  Th*  partial  derivs' 
tires  of  th*  rang*  and  range-rst*  with  respect  to  th*  remaining  varieties  are  sere.  Referring  to  Table  1,  the 
x  ,  y  position  errors  ar*  defined  in  terms  of  longitude  and  latitude,  and  In  unit*  of  radlane,  respectively. 
After  converting  the  pertinent  variable*  to  feet,  th*  syetea  H  satrlx  is  defined  by 


"i.e 


[h.h„h0) 


ye 

Lc«. 


oo*  K 


(3.71) 


1. 1 


Is  the  sea-born*  aechastiatlcu,  8 


and  th*  noia*  procssa  ar*  acdelm. 
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3.3.3  Pul  Observation  Error  Covariance  Matrix  It 

Thi  fj  term  presented  la  Equation  (3.43),  the  observation  noli*  victor,  1*  *a  iddltlvi  rondo*  sequence  with 
known  itktlitlci,  1.4., 

itvjl  =  0  (3.91) 

St?“»T‘‘k.i3  '  0  (3l92) 

=  0  (3.93) 

EtVjffJ}  =  SjjRj  ,  (3.04) 

whin  8j.  is  ths  Kronecker  dilts  snd  Rj  *  Is  s  non- negative  diflnlte  mstrix.  The  R  mstrix,  lor  non- 

dlffersnoing  cases,  Is  *  diagonal  mstrix.  If,  howevsr,  the  satellite  system  provides  more  than  one  satellite 
aad  a  differencing  schemn  Is  used,  the  R  matrix  contains  off-diagonal  elements  as  well. 


In  our  model  the  R  matrix  is  defined  by 


L  ° 


3.4  Real  Tim*  Proctnelng  Considerations 

Stno*  Kalman  mechanizations  consist  of  sits  of  matrix  operation*,  it  oan  readily  be  seed  that  if  the  number 
of  state  variables  in  X  Is  large,  the  matrix  manipulations  oan  become  unwieldy.  Hence,  by  judicious  choice 
of  state  variables,  tbs  system  dimension  oan  be  minimized]  however,  the  degree  of  euboptimallty  oan  be  constrained 
within  limits.  Also  certain  pseudo-itmtes  can  be  implemented  to  approximate  the  effects  of  noise  in  the  system 
rather  than  explicitly  modeling  all  noise  function^  as  states;  for  example,  in  the  form  of 

?kQ  =  *k.k-lPk-l4k.k.l  *  Bk,k-lVlBk.k-l  •  (3. 96) 

extrapolation  of  the  noise  terms  is  incorporated  in  the  Q  matrix  through  a  B  coefficient  matrix.  Obviously, 
such  modeling  eliminate*  the  capability  of  estimating  the  subject  noise  processes.  The  Inversion  required  in 
the  Kalman  gain  matrix  oan  be  simplified  if  the  R  matrix  is  a  diagonal  matrix.  Under  suoh  clroumstanaes  the 
invsrslon  ie  performed  serially  (1.*,,  row  by  row);  this  reduo**  each  row  to  a  scalar  (lx l)  value  or  simply  to 

a  constant  nr  fraotian.  If,  however,  the  Z  matrix  has  sore  than  3  rows,  the  serial  processing  becomes  a  time 

consuming  process*.  The  extrapolation  routine  requires  nxn  matrix  multiply  operations,  whloh  consumes  large 
computer  aesory.  The  eollapslble-matrix-multiply  routine),  based  on  element  indexing,  however,  reduces  memory 
requirements  more  than  on*  half. 

Eaoh  of  the  above  simplifications  aids  in  reducing  the  digital  computer  memory  requirements  for  real  time 
operation. 

Still  another  scheme  to  aid  In  preserving  accuracy  in  a  fixed-point  mechanization  is  a  real  til*  resosling 
module.  This  oan  be  ueed  to  keep  the  covariance  and  related  computations  optimally  eoaled  by  periodically 
checking  the  elements  of  the  covariance  matrix  and  shifting  if  necessary.  A  typloal  situation  where  a  rescaling 
module  would  be  useful  is  postulated  below.  Assume  that  unfavorable  geometric  conditions  prevail  snd  three 

successive  satellite  passe*  are  missed;  near  the  equator  this  would  mean  about  six  to  eight  hours  without  a 

position  fix.  If  positloni  (latitude  error  sod  longitude  error)  are  state  variables  snd  assuming  a  linear 
degradation  of  position,  a  ratio  of  64  to  1  on  the  respective  oovarlanc*  matrix  elements  would  result  if  ths 
fix  occurred  at  8  hours  Instead  of  one  hour.  If  ths  covariance  matrix  were  scaled  to  accommodate  the  worst  case 
condition,  then,  when  the  system  is  operating  at  optimum  accuracy,  significance  is  loet  since  the  data  are 
shifted  to  the  right  In  the  "register".  Essentially  the  scheme  described  above  is  a  "pseudo- floating- point" 
mechanization.  A  true  floating  point  mechanization  could  be  implemented  if  system  processing  time  snd  memory 
constraint!  were  not  severe.  Computational  precision  oan  still  be  a  problem  in  floating  point  if  sufficient 
data  bits  are  not  carried. 

Another  concept  to  oonelder  ie  the  effector  the  finite  word  length  of  the  on-board  computer  on  the  Kalman 
filter-estimator  mechanization. 

All  these  problems  may  be  evaluated  through  us*  of  a  sophisticated  simulation  program  which  includes  the 
following; 

Simulation  of  filter/ senior  mismatches  and  their  effects  on  system  navigation  performance. 

Simulation  of  the  euboptlaal  filter  snd  of  Its  effects  an  system  navigation  performance  (1.*.,  the  effects 

of  negleoting  som  of  the  state  variables). 

The  auto-invert  routine  Is  the  optimal  solution  for  ur  to  3  x]  aatrloss.  The  concept  may  be  extended  to  multiples  of 
3  or  sodifled  for  3x]  tad  Its  eultlplee. 

t  The  collepelble-astrli-sultlply  rout  Ins  hem  been  elsulsted  end  used  In  nuoerouS  occasions  Is  slr/setboriie  Kalman  flltsr 
Section  last  lone. 
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Simulation  of  the  finite  word  length  of  the  on-board  cosputsr  and  Its  effects  on  arat.cn  cavitation  performance. 

The  probltaa  preaected  above  may  be  rigorously  analyzed  throutb  the  use  of  the  REAL-WORLD-COVARIANCE  concept* 
and  addition  of  word  length  Banking  Inatructlone  to  each  arlthaetlcal  etatement. 


4.  DYNAMIC  SIMULATION  RESULTS 

In  order  to  evaluate  the  ayatem  performance,  several  configurations  were  simulated.  The  mlstion  profile! 
ud  performance  results  are  presented  below. 

4. 1  Mlealon  Profile 

Two  missions  were  simulated.  The  first  mission  assumed  Is  described  by  a  course  originating  near  the  equator 
which  la  consistent  with  about  ninety  minutes  between  satellite  puses.  The  ship’s  speed  is  10  knots  st  a 
beading  of  45°.  Pltohlng  and  rolllns  motions  of  the  ahip  were  assumed  to  be  3°  and  3°,  respectively. 

A  variable  water  profile  wss  assumed  to  Illustrate  the  degradation  in  water  depths  of  0-400  ft  and  400-000  ft. 
Depths  greater  than  600  ft  were  not  considered  In  the  error  analyses  described  in  the  following  section  because 
the  sea  current  drifts  swamp  the  remaining  system  error  sources.  However,  under  such  conditions,  s  locsl  sea 
current  biaeing  oan  be  realized  by  implementing  corresponding  states  in  the  stats  vsotor. 

Tbs  second  mission  originated  at  30  degree*  North  latitude  and  118  degraea  West  longitude.  Ship's  ipetd  wss 
initially  aero  and  it  accelerated  to  B  knots  while  simultaneously  turning  from  s  heading  of  30S  degrees  to 
319  dsgrses.  For  the  remainder  of  the  five  and  cue  half  hour  mission,  the  ship  remained  on  *  straight  ooursa. 

The  ship’s  dynamics  ars  as  described  shove. 

4.2  Error  Analysis  Results 

Basic  assumptions  relating  to  the  system  mechanization  in  ths  flrat  elision  simulated  are  u  follows: 

(1)  Ship's  attitude  compensation  la  implemented.  Inclinometer  mrrors  are  about  0.3  degress  per  sals. 

< 11)  Qyro  motion  compensation  is  Included.  A  standard  heading  error  of  0.5  degress  tor  the  non-Kalman 
filtered  aeohinlzstloni  Is  shown.  The  same  gyro  dasptd  with  Kalman  filter  corrections  results  In  a 
heading  trror  of  leas  than  0. 15  degress. 

(ill)  A  one  sigma  position  error  of  300  ft/axls  is  usuamd  for  the  static  satellite  rioelvsr  subsystem  error. 

(It)  The  sonar  Doppler  errors  ara  a  function  of  water  depth  sod  are  described  in  section  2. 

(r)  Satellite  slavatlon  angle*  at  oloasit  approach  ars  between  20  end  SO  degrees. 

Figure  7  Is  a  plot  illustrating  tbs  radial  position  time  history  for  thres  configurations  In  the  first  mission. 
Ths  initial  error  Is  assumed  to  be  zero.  This  Is  Justifiable  since  the  satellite  yields  position  flxss  which 
ara  xtro-msan  processes.  Hence,  by  taking  many  fixe*  at  tha  same  static  location,  ths  position  error  in  ths 
limit  approaches  zero.  In  the  first  ninety  mlnutee  the  radial  arror  grows  monotonlcally,  at  which  point  tbs 
satellite  is  assumed  overhead.  At  this  point  ths  system  is  rust.  Note  that  ths  Kalman  filtered  mechanization 
Is  rust  to  s  lower  value  and,  In  the  subsequent  ninety  minutes,  the  srrer  growth  Is  st  s  reduced  rats  relative 
to  ths  non-flltered  systems.  This  rssults  from  the  orou-csUtratlon  of  the  navigation  ssnsors  upon  reosipt  of 
satellite  tlx.  As  shown  in  Figure  7,-  the  residual  position  error  st  each  fix  gets  progressively  hatter,  from  the 
increased  knowledge  of  tha  system  error*. 

The  error  profile  for  ths  sscond  mission  la  ihowu  la  Flgur*  8.  Tbue  curves  were  generated  using  a  dynamic 
simulation  with  the  48  etste  variable*  duorlbtd  In  Section  3.  The  obisrvatlon  vectors  employed  wars  rings  and 
rsnge-rate,  as  Indicated  on  the  figure.  The  range  error  la  170  feet  per  observation  and  the  range-rate  arror  la 
0.  l  ft/sec  per  observation.  A  gradual  update  Is  indioatsd.  alnoa  a  range  and/or  range-rate  observation  is  made 
•very  one  minute.  Puiei  of  variable  duration  and  spacing  were  simulated  to  approximate  a  real-world  environment. 
As  cited  above,  tha  general  Improvement!  In  accuracy  are  also  preaent  in  this  plot  with  one  explainable  exception  - 
ths  fix  at  five  hour*.  The  reuldual  tor  this  fix  Is  higher  than  ths  previous  fix  rssidusl,  due  to  the  satellite/ 
user  geometry. 

The  deed  reckoning  error  la  larger  for  the  ascend  mixtion,  due  to  tb«  additional  errors  relating  to  tha 
equipment  that  wsr*  Implemented.  For  instance,  frequency  offset  errors  wers  sssumsd  for  tbs  sonar  Doppler  and  ' 
vsloolmstsr.  Soils  factor  errors,  non-orthogonalities,  mass  unbalance  and  aniloslutlolty  ears  Initialized  to 
describe  the  gyrd  ooqiau  aa  sell  ea  gyro  drift*.  The  initial  heading  error  wu  set  at  0.75  dsgrses  and  wu 
corrected  down  to  0. 08  degress  st  the  tlx. 


Tbs  concept  Is  to  simulate  an  opt  leal  sxtrapolator  lb  parallel  with  the  subopt laal  one  Tbs  Kalssn  sain  cosputsd  la  ths 
■Uboptieal  filter  Is  applisd  to  ths  reel-world  (full-else)  covariance  sstrlx.  Hence  tbs  scientist  ocoductlng  the  study  bis 
st  his  disposal  tso  (i.a. ,  reai-world  sad  syatea)  cover  lues  metrics*.  Obviously,  the  reel-world  covariance  sstrlx 
amputation  It  ths  sals  Indication  of  the  suboptlsally  ooaputed  Kalian  gain  effects  in  real  world. 
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